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AREA NAVIGATION IMPLEMENTATION FOR A MICROCOMPUTER-BASED 

LORAN-C RECEIVER 


This report describes the development of an area navigation program 
and the implementation of this software on a microcomputer-based 
Loran-C receiver to provide high-quality, practical area navigation 
Information for general aviation. This software provides range and 
bearing angle to a selected wayj»oint, cross-track error, course 
deviation indication (CDI), ground speed and estimated time of 
arrival at the waypoint. The range/bearing calculation, using an 
elliptical earth model, provides very good accuracy; thv error does 
not exceed more than 0.012 nm (range) or 0.09“ (bearing) for a maxi- 
mum range to 530 nm. a~3 filtering is applied in order to reduce 
the random noise on Loran-C raw data and in the ground speed calcu- 
lation. Due to the a-S filtering, the ground speed calculation has 
good stability for constant or low-accelerative flight. The execu- 
tion time of this software is approximately 0.2 second. Flight 
testing was done with a prototype Loran-C front-end receiver, with 
the Loran-C area navigation softwat demonstrating the ability to 
provide navigation for the pilot to any point in the Loran-C cover- 
age area in true area navigation fashion without line-of-sight and 
range restriction typical of VOR area navigation. 


by 

Fujlko Oguri 



Avionics Engineering Center 
Department of Electrical and Computer Engineering 
Ohio University 
Athens, Ohio 45701 


August 1983 


Prepared for 

NASA Langley Research Center 
Hampton, Virginia 23665 
Contract NGR 36-009-017 


(NASA-CR- 173048) ABEA NAVIGATION 
IMPLEMENTATION FOR A MICBOCOMPOTEE~BASED 
LOEAN-C BECEIVEE (Ohio Univ.) 150 p 
HC A07/I1F AOl CSCL 17G 



G3/04 


Unclas 

15130 



4 ' 


TABLE OF CONTENTS QRIGtr^L Pim Itil' 



OF POOR QUAUW 

PAGE 

List of Figures 


iii 

List of Tables 


vii 


I. INTRODUCTION AND SUMMARY 1 

II. PROBLEM DESCRIPTION 2 


A. Present-Day Navigation System 2 

1. VOR/DME system 2 

2. RNAV using VOR/DME system 2 

3. Other systems 4 

B. Low-altitude Navigation Using Loran-C ‘ 10 

III. LORAN-C NAVIGATION 13 


A. Background 13 

B. Low Frequency System 13 

C. Loran-C Time Difference 13 

D. Computation of Time-Differences ’ 14 

E. Converting Time-Difference 20 

F. Area Navigation ^22 


IV. COMPUTATION FOR AREA NAVIGATION 


23 


A. Range and Bearing Angle 23 

1 . Spherical model 23 

2. Simplified elliptical model 25 

3 . Elliptical model 27 

4 . Comparison among three models 30 

B. Other Navigational Information 30 

1 , Cross-track error 30 

2. Ground speed and estimated time of 36 

arrival 36 

C. A Scheme for Microcomputer Use 40.i 

V. THE MICROCOMPUTER SYSTEM / 42 

„'.’A. A System Design 42 

1.’ Hardware 42 

^ 2. Interfacing sof tware 42 

• ; Navigational Program 47 

. . 1./ Relationship among navigational programs » 47 

2.. RNAV program 52 


TABLE OF CONTENTS (Continued) 


PAGE 

VI. tSSTS ON MICROCOMPUTER 64 

A. Testing with Simulations 64 

B. Flight Testing 68 

1. Filtering time differences 68 

2,. Ground speed 68 

3. Range/ bearing, CTE/CTEB and CDI indications 79 

VII. CONCLUSIONS AND RECOMMENDATIONS 90 

VIII. ACKNOWLEDGEMENTS 92 

IX* REFERENCES 93 

X. APPENDICES 96 

A. The Computation for An Area Navigation (RNAV) 96 

Equipment based on the use of VOR/DME 

3. Program Listing for Testing Range and Bearing 98 

Angle Computational Models 

C* Program Listing for Hicroprotessor Version of 101 

Area Navigation (RNAV) Program 

D. Program Listing for Testing Flight Teat Data 136 

E. Program Listing for Testing Flight Test Data 139 




LIST OF FIGURES 

PAGE 


Figure 2-1 VOR/DME Navigation System 3 

Figure 2-2 NDB (ADF) Navigation System 5 

Figure 2-3a Flying to/from Station v/ith Cross-w.vnd, VOR with 6 

wind correction 

Figure 2-3b Flying to/from Station with Gross- 'Kind, ADF 7 

without correction 

Figure 2-A Omega Navigation System 8 

Figure 2-5 GPS Navigation System 9 

Figure 2-6 Present Loran-C Coverage Area in the United States 11 

Figure 3-1 Loran-C Transmitted Signal Format 15 

Figure 3-2 The TD Values Received at Point P from the Loran-C 16 

Stations 

Figure 3-3 TDs Received from the Various Master-Secondary 17 

Pairs Define LOPs which all Intersect at the 
Receiver's position ' ^ i 

*1. ' t \ »■ « . 

Figure 3-4 The TD Reading at the Receiver 18 

Figure 3-5 Relationship between Loran-C Hyperbolic LOPs and 21 

Geocentric Grid 

Figure 4-1 Spherical Model 24 

Figure 4-2 Simplified Elliptical Model 26 

Figure 4~3 Circumscribing Sphere around the Elliptical 28 

Earth Model 

Figure 4-4 Elliptical Model 29 

Figure 4-5 Accuracy Comparison Among Three Models 31 

Figure 4-6 Cross-Track Error (CTE) 35 

Figure 4-7 Ground Speed (GS) 37 

Figure 4-8 Process-1 (One a“8 filter) and Process-2 (Two 38 

a-p filters) for Ground Speed Computation 

Figure 4-9 Flow Chart of Navigation Programs for Ohio 41 

University Loraa-C Receiver 



‘III 





LIST OF FIGURES (CONTINUED) 

PAGE 

Flgute 5-1 

Block Diagram of Total System, O^io 
University Loran-C Receiver 

43 

Figure 5-‘2 

Instruction Set of MOS Technology 6502 

44 

Figure 5-3 

Instruction Set of Am95IlA 

45 

Figure 5-4 

Block Diagram of Microcomputer Navigational System 

46 

Figure 5-5 

Logic Flow Diagrams Illustrating Steps Control 
Program Executes to Communicate with 9511 

48 

Figure 5-6 

Process Of Loran-C Navigation Program 

50 

Figure 5-7 

Memory Map of Loran-C Navigation Software 

51 

Figure 5-8 

Flow Chart of RNAV Program 

53 

Figure 5-9 

Flow Chart of Waypoint Conversion 

55 

Figure 5-10 

Steps of Waypoint Conversion 

56 

Figure 5-11 

Flow Chart of Cross-Track Error and Cross-Track 
Bearing 

59 

Figure 5-12 

CDI Display 

60 

Figure 5-13 

Flow Chart of Ground Speed 

61 

Figure 5-14 

Loran-C Receiver CRT Display 

62 

Figure 5-15 

Photograph of Ohio University Loran-C Receiver 

63 

Figure 6-1 

Area Navigation Computation from a Receiver's 
Point to a Waypoint Using Fixed Tinie of Position 

66 

Figure 6-2 

Flight Path Plot, Result of Flight Test-1, 

a-p filter ( t£»6 seconds , a«0.167, B“0.007) on TDs 

69 

Figure 6-3 

Flight Path plot, Fortran Simulation of Flight 
Test-1 using nonfiltered TDs 

70 

Figure 6-4 

Flight Path Plot, Fortran Simulation of Flight 
Test-1 using filtered TDs a~B filter (tj=6seconds , 
a“0.167j B«0.007) on TDs 

71 

Figure 6-5 

Result of Flight Test-1, a-B filter(t£*12seconds, 
a*0.084, 3=0.017) in Ground Speed Calculation 

72 


1 

\ 


IV 


w 

1 r 

1 * t 

ORIGINAt, PAGE tE 

! OF POOR QyAUW 

LIST OF FIGURES (CONTINUED) 




PAGE 

Figure 6-6 

Flight Test-1 Fortran Simulation of Ground 
Speed Using Unfiltered TDs, Nonfiltered TDs, 
No filter in ground speed calculation 

73 

Figure 6-7 

Flight Test-1 Fortran Simulation of Ground 
Speed using nonfiltered TDs, a~3 filter 
(t£=12 seconds, a=0.084, 0=0.0017) in Ground 
Speed Calculation 

74 

Figure 6-8 

Flight Test-1 Fortran Simulation of Ground 
Speed using filtered TDs, No filter in Ground 
Speed Calculation 

75 

Figure 6-9 

Flight Path Plot, Result of Flight Test-2 
a-0 f liter (t^=6seconds’, a=0.167j; 0=0,007) 
on TDs 

76 

Figure 6-10 

Flight Path Plot, Fortran Simulation of 
Flight Test-2 using nonfiltered TDs 

77 

Figure 6-11 

Flight Path Plot, Fortrsn Simulation of Flight 
Test-2 using Filtered TDs, cx-0 filter( tj-=4seconds , 
a=0. 251, ' 0=0 .016) on TDs- 

78 

Figure 6-12 

Result of Flight Test-2, a-0 f liter ( t£=12seconds , 
a=0.084, 0=0.0017) in Ground Speed Calculation 

80 

Figure 6-13 

Flight Test-2 , Fortran Simulation of Ground 
Speed using nonfiltered TDs, No filter in 
Ground Speed Calculation 

81 

Figure 6-14 

Range (NM) Time (Minutes), 

Result of Flight Test-2 

' ' ' ‘ * * ■ 1* ‘ ' 

82 

Figure 6-15 

Bearing Angle(degree)- - Time(mihute) , 
Result of Flight Test-2 

83 

Figure 6-16 

Range(NM) - Tirae(minutes) , 

Fortran Simulation of Flight Test--2 

84 

Figure 6-17 

Bearing Angle( degrees) - Time( minutes) ' 
Fortran Simulation of Flight Test-2 

85 

Figure 6-18 

Cross-Track Error Bearing( degrees)- Time (minutes) 
Result of Flight Test-2 

86 

Figure 6-19 

Cross-Track Error(NM) - Time(minutes) 
Result of Flight Test-2. 

87 


i 


v\ 


r 


LIST OF FIGURES (CONTINUED) 


Figure 6-^20 Crose-Track Error(NM) - Time(miilutes) 
Fortran Simulation of Flight Test-2, 
Right/Left off-course Indication Is 
corrected 

Figure 6-21 Photograph of Ohio University’s Loran-C 

Receiver inside the Piper Cherokee During 
Flight Testing 

Figure A-1 Area Navigation (RNAV) Equipment 


PAGE 

88 

89 

97 


vi 


ts ’ 




LIST OF TABLES 





PAGE 

Table 

4-1 

Numerical Comparison Among Three Models 
(Fortran Simulation) 

32 

Table 

4-2 

Number of Mathematical Operation *in Each 
Model < , 

34 

Table 

6-1 

Accuracy of Microcomputer Range/Bearing 
Computation vd.th Elliptical Model 

65 

Table 

6-2 

Test Result of Area Navigation Computation 
Using Fixed Time Differences 

67 



I. 


INTRODUCTION AND SUMMARY 


This paper describes specific engineering work which has been 
done bo make Loran-C a more useful and pracbical navigation system for 
general aviation. This work, in particular, deals with development of 
new software, and implementation of this software on a (M0S6502) micro- 
computer to provide high quality practical area navigation information 
directly to the pilot. Flight tests have been performed specifically to 
examine the efficacj’' of this new software. Final results were e:icep- 
tionally good and clearly demonstrate the merits of this new Loran-G 
arej navigation system* 

LORAN-C (Long Range Navigation) is a hyperbolic, radio navigation 
system that has been in operation since 1958 [1] . It uses ground waves 
at low frequencies to provide positional Information, not restricted to 
line-of-sight [2] . This system can be used in nearly all weather con- 
ditions to obtain position accuracies which are essentially independent 
of altitude. As of 1983, it is not yet a complete navigation system in 
the United States. In the midwest, which constitutes one third of the 
U.S. land area, coverage is deficient for some flight operations. 

The VOR/DME (VHF Omni-directional Range/ Distance Measuring 
Equipment) navigation system is well known as the contemporary, short- 
range navigation system which covers the whole United States with over 
1000 stations, but this system is sensitive to siting and terrain, and 
has limits for low altitude coverage because VOR is a line-of-slght 
s'ystem. By relieving these shortcomings, Loran is considered to be a 
possible supplement for VOR/DME system [3] . 

The hyperbolic lines of position associated with Loran-C present 
a problem for the pilot. Historically, the hyperbolic lines of position 
do not convert readily to a meaningful display without comparatively 
high airborne equipment cost. However, the present availability of 
microprocessors makes low-cost airborne coordinate conversion equipment 
feasible. Contemporary technology provides for light-weight small- 
volume equipment with a low power drain for small aircraft. Thus, auto- 
matic Loran-C navigation can be made practical for general aviation 
users simply by making use of a microcomputer. 

In this paper, work is described indicating rather elemevitary 
mechanizations that can provide the pilot very useful navigation at all 
altitudes. This development of software provides Area (Random) Naviga- 
tion (RNAV) information from Time Differences (TDs) in raw form using an 
elliptical earth model and a spherical model. It is prepared for the 
microcomputer based Loran-C receiver which was developed at the Ohio 
University Avionics Engineering Center. In order to compute naviga- 
tional information, a microcomputer (MOS6502) and a mathematical chip 
(Am9511A) were combined with the Ohio University Loran-C receiver. 

Final data in the report reveals that this software indeed provides 
accurate information with reasonable operation times. 


II 


PROBLEM DESCRIPTION 


The purpose of an air navigation system Is to provide position 
information to a pilot in all weather conditions. In order to achieve 
tViis goal, certain operational factors, such as accuracy, coverage, 
integrity and reliability must be considered. 

A. Present-Day Navigation System . 

1 . VOR/DME system . Early air na,vigation relied heavily on 
good visibility and pilot skill. However, increased interest in 
aviation as a viable transportation system necessitated developing navi- 
gation equipment that would provide guidance In all weather conditions. 

By the 1930s, radio navigation systems were being used routinely. 
The VOR (Very High Frequency Omnidirectional Range) was developed by the 
end of the Second World War, and shortly thereafter, was put into use 
across the U.S. VOR was accepted as the International standard for air 
navigation the International Civil Aviation Organization (ICAO) in 
1949. VOR transmissions, which range in frequency from 108 to 118MHz, 
provide signals which the airborne receiver uses to define an angular 
bearing with respect to the transmitting station [4]. 

In the l960’s, DME (Distance Measuring Equipment) was added to VOR, 
as a part of the colocated TACAN (Tactical Air Navigation) ground-radio 
beacon system fS]* DME determines the distance from the VORTAG to the 
aircraft, therefore, a VOR-DME station (or VORTAC) provides magnetic 
bearing and the distance to the station for the pilot (figure 2-1). The 
VOR/DME system is relatively easy to use and easy to visualize in a nav- 
igation sense; hence, it has become a useful, practical system for civil 
aviation users. 

While the VOR/DME system satisfies most of today's enroute navi- 
gational requirements, it has some notable disadvantages. One of these 
is a result of the fact that VHF propagation is essencially line-of- 
sight, meaning that there must be no obstructions between the transmit- 
ter and the receiver. Thus, low-altitude aircraft cannot receive signals 
from behind mountains, or in valleys. Consequently, even with more than 
1000 VOR stations operating in the United States, complete low-altitude 
coverage is not provided. Further, there is a high cost associated with 
the maintenance of 1000 stations. Moreover, low-altitude aircraft like 
helicopters may need additional systems to fulfill their navigational 
requirements . 

RNAV using VOR/DME . The definition of Area/Random Navigation 
(RNAV) according to Advisory Circular 90-45A, is as follows [6j; 

'A method of navigation that permits aircraft 
operations on any desired course within the 
coverage of station referenced navigation 
signals or within the limits of self-contained 
system capability.' 
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Figure 2-1 . VOR/DME Navigation System. 
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RNAV equipnu ' t (primarily VOR/DME dependent systems) is now 
available on the market which enables an aircraft to fly directly to any 
destination within VOR/DHE signal coverage area. A discussion of the 
computations involved with RNAV is given in appendix A. Numerous equip- 
ments are currently marketed to perform these coordinate translations, 
conversion and rotations (e.g., King Radio Corp, KNS-81 Navigation 
System) . 

Although a large number of RNAV routes have been established by 
the FAA, the 'line-of-slght' problem has not been solved for low- 
altitude navigation. 

3. Other systems . There are other navigation systems, such as, 
Non-Directional Beacons (NDB), Omega, inertial navigation. Global 
Positioning System (GPS) and Loran-C. 

The NDB, sometimes called ADF (Automatic Direction Finding), sys- 
tem operates in the 200 to 1600 KHz bands to indicate the direction of a 
selected ground station with respect to aircraft heading as depicted in 
figure 2-2. This system is inexpensive but does not provide the guid- 
ance afforded by VOR. For example, if there is crosswind, the aircraft 
may drift with respect to the desired path [7] . A comparison between 
VOR and ADF in the presence of a crosswlnd is shown in figure 2-3. And 
also, ADF is only as accurate as the magnetic compass. 

Omega Is a very-low-frequency (VLF) hyperbolic navigation system 
which offers nearly worldwide coverage with eight stations. Position 
determination is based on a comparison of phase values obtained from the 
signal of three or more transmitting stations (figure 2-4) . Inaccuracy 
can be caused by ionospheric changes and conductivity of the ground. 
Therefore, the system needs propagation-phase-correction for proper 
phase stability. Lane skipping also causes inaccuracy. Consequently, 
it is a suitable aviation aid primarily for long-range, oceanic naviga- 
tion [8], or for updating inertial systems. 

The inertial system is a completely self-contained navigation 
system based on the measurement of aircraft acceleration using accelero- 
meters and gyros. It provides position, velocity, altitude and heading 
at all latitudes in all weather [9]. However, because the position and 
velocity information degrades as a function of time elapsed and the air- 
borne system expense is high, this method, used alone, is unsuitable for 
the general aviation applications. 

GPS is a radio-navigation system using satellites in space. 
Extremely accurate three-dimensional position and velocity information 
can be obtained from the system worldwide and unaffected by weather con- 
ditions. The position deteimiination is based on the measurement of the 
transit time of microwave signals from four or more satellites. Three 
satellites permit solving of the user position equations in three dimen- 
sions, and the fourth satellite estimates the user's clock error [10] 
(figure 2-5). GPS is still being tested and is expensive; however, the 
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Figure 2-5. GPS Navigation System. 


implementation will begin in 1986 and will be completed approximately 
two years later [11] . It is regarded by some as a future navigation 
system which has a capability to be a single universal system. 

The Loran-C system is now being evaluated as a supplemental sys- 
tem, and possibly, as a replacement for the contemporary VOR/BME system, 
which is described in the next section. It is the Loran-C system that 
is addressed in this paper. 

B. Low-Altitude Navigation Using Loran-C . 

Loran-C system uses a pulsed, low-frequency (LF) signal, result- 
ing in a hyperbolic navigation system. The intrinsic stability of LF, 
and the time difference measurement of pulsed signals, provide reason- 
able accuracy (about 2-D r.m.s. system error of ±0.3nm). 

The relativTily low propagation path losses of LF ground waves, 
and the resulting long station-to-station separation provides a wide 
coverage area, including low altitude coverage in mountains and valleys. 
Thus , about 40 stations are sufficient to cover the entire, continental 
United States [12]. Figure 2-6 shows the present Loran-C coverage area. 

Three or four Loran-C radio navigation transmitting stations are 
constructed to form chains. Two sets of hyperbolic lines give position 
information in a hyperbolic coordinate system, and this information can 
be readily used as input to an RNAy computer. As a result, if the 
Loran-C user chooses, he can perform great-circle navigation between any 
two points within the coverage area of the entire Loran-C system. 

There are certain problems associated with the use of Loran-C. 
Geometric Dilution of Position (GDOP) causes inaccuracies typical of any 
hyperbolic system. Inaccuracy arises when the crossing angle of two 
lines of position is small or when, the aircraft position is near the 
baseline extension for a ma,ater-secondary pair. Operating too close to 
the transmitter also causes instability on time difference (TD) readings 
[13] . However, these problems can be avoided by provisionally using 
another station, or avoiding passage near a station. 

There are other problems due to interference caused by natural 
causes and by man-made sources . Static and lightning are examples of 
natural interference. However, static noise reduction from 20dB to 50dB 
in the Loran-C frequency band is achieved by Implementation of static 
dischargers for aircraft [14] . Man-made sources such as powerline 
carrier systems and noise sources near airports cause some interference. 
According to some measurements, interference was found when the carrier 
frequency of powerline is synchronous with the. frequency of the Loran-C 
pulse spectrum, and solutions to this problem are still under consider- 
ation. Interference measurements near major airports did not show 
significant Interference to Loran-C receivers [15] . 

The effect of station outages is another problem; reliability of 
Loran-C stations must be increased for practical, safe air navigation 
[16]. 
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Figure 2-6. Present Loran-C Coverage Area in the United States. 




Early Loran-C receivers were configured for military use. Since 
Loran-C requires a relatively complex signal processing system for air- 
borne use, they cost $40-50,000, which made them Impractical for general 
aviation. This processing can be achieved with a low-cost microcomputer 
as is presented here. This allows a high-performance Loran-C receiver 
to be in the the cost and size range that is attractive for general 
aviation usage. 
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in. LORAN-C NAVIGATION 


A. Background. 

During World War II, Loran-A was developed as a pioneering long- 
range radio navigation system at the Radiation Laboratory of the Massa- 
chusetts Institute of Technology (MJ.T), and operated under the U.S. 

Coast Guard to satisfy wartime heed. L6ran-A operated at 1600kHz and 
provided jposltiott information to receivers aboard niilltary arid commer- 
cial Ships and planes. Beginning in 1977, it has been phased out with 
the shut down of the final chain In 1980. 

After the war, the Department of Defense developed a new genera- 
tion of radio navigation system, called Lorari-G, operating at lOOkHz. 
Loran-C provides Improved accuracy and Increased area of coverage. The 
Loran-C system began to replace Loran--A in the late 1950s. ,.*e Depart- 

ment of Defense predicted that the Lorari-C system would cover all of the 
coastal waters and the entire U. S. by the end of this decade [17]. 

Low Frequency System . 

The Loran-C system uses time measurement with ground waves at low 
frequency (LF) . LF signals, which are the most suitable for time mea- 
surement accuracy, have predictable ground wave propagation conditions 
though they are subject to Skywave interference at long ranges. 

Although very low frequency (VLF) Chn also be used for long range 
air navigation (e.g., navigation with the international Omega system), 
propagation, mainly by sky wave ot the waveguide node, depends on 
ionospheric conditions which vary with time of ddy and season* Though 
the cyclic redundancy of the transmitted signals cause a larie identifi- 
cation problem, there are adjustments which can be used to successfully 
overcome it. 

Mediiun frequency (MF) and high frequency (HF) signals meet the 
requirement for the time measurement but, unfortunately, suffer high 
propagation losses over land and loss of propagation due to natural and 
man-made physical characteristics whose size is a significant fraction of 
a wave length [18] . 

Hence lOOkHz low frequency was Selected for Lotan-C to take 
advantage of the stable propagation and long range of this frequency 
band [19]. 


C. Loran-C Time Difference, 


The Loran-C chain contains a master station and two to four sec- 
ondary stations. The tranSioitting Stations of the chain transmit groups 
of pulses forming a Group Repetition Interval (GRI).^ Each station has 
its own GRi in the range of 49900 ps to 99900 ys. The master station 
transmits a nine-pulse group spaced 1000 ysec with 2000 ysec between the 


-13 


ORIGINAL PAGS IS 
OF POOR QUALITY 

eighth and ninth pulses. Secondary stations transmit an eight-pulse 
group with pulses spaced 1000 psec. The secondary stations transmit 
after a coding delay and a baseline delay that is specific for each 
secondary in the chain (figure 3-1). 

Measuring the time differences (XDs) between arrival of pulse 
sets from different stations can be used to locath the receiver’s 
position., The hyperbolic navigation system operates on the Loran-C TD 
readings . because narrow bandwidths at low frequencies do not allow high 
enough data rates to transmit signals’ with a higher information fcontent 
than the presence or absence of the pulse at a given time. 


The TD value is found by measuring the difference in time of 
arrival of a set of pulses from two stations. A constant tD number 
traces a hyperbolic line (figure. 3-2) , The hyperbolic equation (3-2) 
is constructed as follows, 



+ y 


J (x- 


c)^ + y^ 



r-/ 


. (3-1) 


where d^ and dj, are the distances from each station' to the, receiver . , 
Put d* and dU in (equation 3-1) and rearrange the equation 



(3-2) 


where c = /a + b ; point a is the intersection point between the hyper- 
bola and the X-axis, and b is the conjugate axis length.' ‘ . 


Each hyperbolic locus of points traces a line of position (LCiP) . There- 
fore, a second master secondary pair must be tised to trace a second LOP, 
and the. crossing point of two' or more LOP s. define the receiver's .loca- 
tion (figure 3-3). ‘ . 

D. Computation of Time-Differences. , . 


The master station transmits a signal In all directions, once per 
GRI, theji .‘secondary stations transiait, after the transmission time of 
the signal frW the master, station to the .secondary station (baseline 
time) plus a coding delay. The delay avoids overlapping signals from 
secondary stations anywhere in the coverage region (figure 3-4) . . 
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Secondar)/ 

3 + A (Cording delay added 
Q by seconda;y) 





Figure 3-4. The TD Reading ah the Receiver. 


The receiver gets two signals from the master and tlie secondary, 
separated a TD. This TD In mathematical form Is; 

TD - + A + Tg - Tjj 

where TD ** the time difference itx arrival of the roaster 
and secondary signals 

g « the one-way baseline time between the master 
and secondary 

A » the secondary coding delay Inserted by the 
secondary 

Tg “ the one-way baseline time between the 
secondary station and the receiver 

T^ “ the one-way baseline time between the 
receiver and the master station 

The baseline time g and the coding delay A generally known 
quantities which are set up during the installation of the Loran-G 
chain. These two quantities are published in the data for each chain by 
the U. S. Coast Guard [20] . The two baseline times to the receiver, T 
and T^, have unknown values and must be calculated in order to be 
applied to the TD equation. 

There are two factors involved for the computation of the value 
of travel time from one point to another. In calculating the accurate 
baseline dlstnuce between the two points one should consider the non- 
spherlcal nature of the earth, and the corrections to the velocity of 
the signal which are required when it passes through the medium along 
the baseline. The velocity of propagation is mostly affected by the 
conductivity of the earth and the dielectric constant of the air [21] . 

The baseline length between two points on the earth will be pro- 
vided by using the elliptical method (Chapter IV) . This method uses an 
oblate spheroid model of the earth to approximate the geodesic. Accord- 
ing to the testing (Chapter IV), til usually is adequate for Loran-C 
work. 


If the Loran-C signal travels over the baseline path with a 
constant velocity, independent of the adjacent medium, the above method 
may be used to calculate time differences. As a matter of fact, the 
Loran-C signal travels over a surface vdiich has inhomogeneous conduc- 
tivity and dielectric constants, and also has irregular terrain [22] . 

An attempt to resolve the problem of predicting the signal phase 
delay is very difficult because of the nonspherical and the irregular 
nature of the surface impedance of the earth. An integral equation 
model of an inhomogeneous and irregular earth, was proposed by Samaddar [23] , 
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to predict the secondary phase delays. This calculation is complex and 
does not obtain a valuable phase factor correction. More general imped- 
ance models are typically applied by the Defense Mapping Agency. 

E. Converting Time-Difference . 

The time difference measurement, vjhich was discussed in the pre- 
vious chapter, does not directly provide generalized position coordi- 
nates such as latitude and longitude to the Loran-C users. Although the 
time differences contain position information, they should be converted 
into poo.,tion coordinate systems. 

The classic conversion method is through the use of charts, naps 
<'vnd tables. This method is adequate for low velocity craft like a ship, 
tut not for high velocity aircraft. Therefore, the Loran-C receiver 
should have an automatic conversion from TD to the actual position coor- 
dinate system. 

There is no simple relationship between the Loran-C lines of 
position (lop) and a geocentric grid coordinate system (figure 3-5) [24]. 
However, there are many ways for the conversion, and basically, there 
are two main methods . One requires Iterative calculations that lead to 
the final result, and the other uses a direct or clos'i-form solution to 
do the conversion. 

The iterative TD-to-posltion method assumes the receiver's posi- 
tion first, then compares the position determined by the received TDs 
and the assumed receiver position. Before the comparison, the TDs for 
the assumed position are calculated and then the assumed position is 
regulated to minimize the error in the TDs comparison. This mechanism 
prepares two tables. A table of TD values is generated encircling the 
covered region of the three sets of Loran-C stations and the other table 
is generated to the corresponding positions for the TD table. After 
receiving a pair ofi Loran-C TDs, a linear Interpolation process is 
applied between the two tables to find the position. This is repeated 
until the difference between the two sets of TDs, becomes small for posi- 
tion estimation [25] . 

There are other ways which relate received TD values to assumed 
TD values. Those ways calculate TD errors from a comparison between 
measured TDs and assumed TDs, and move the assumed position according to 
TD errors until errors become acceptable. 

The non-iterative, or closed form solution, method provides the 
actual position of the receiver by setting the received TDs as parame- 
ters in spherical equations . Then the unknown values which represent, 
the receiver’s position are calculated by solving the equations. It is 
generally complicated to find the relationships between position on a 
Loran-C hyperbolic grid (geocentric grid) and spherical angles. Besides, 
the non-spherical nature of the earth and the non-constant propagation 
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attributes of the Loran-C signals, as discussed in Chapter III.C, 
require corrections depending on local conditions. For a non-iterative 
solution, a general nx)del which covers a large area is needed to make 
corrections. However, the non-iterative ^solution can be simple if exact 
solution is not necessary. 

For the Ohio University Loran-C receiver, a non-iterative, expli- 
cit solution presented by Razin [26] was adopted for TD-to-position con- 
version. The TD-to-position conversion software for the microcomputer 
was developed by Fischer [27]. 

F. Area Navigation. 


Since the Loran-C system provides position information at any 
point inside the wide-coverage area, this position information can be 
used for Area(or Random) Navigation(RNAV) which provides range, bearing 
angle, ground speed, cross track error and estimated time of arrival 
based upon arbitrarily-positioned waypoints. It is very convenient for a 
pilot to have this information in order to fly on a desired course to a 
selected waypoint. Area navigation with charts and maps is possible, 
but inconvenient for aviation use because the pilot needs updated infor- 
mation every second during the flight. 

The Loran-C system has automatic area navigation capability. The 
VOR/DME-based RNAV system also provides this information, but this sys- 
tem needs a VOE receive.r, DME plus 8NAV computer. The Loran-C receiver 
developed at the Ohio University Avionics Engineering Center computes 
all navigational information with one microprocessor. The portion of 
this computation for area navigation is discussed in the next chapter. 
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IV. 


COMPUTATION FOR AREA NAVIGATION 


In order to provide sufficient area navigation information for a 
pilot, proper computation should be made by the software of a micro- 
computer-based Loran-C receiver. 

It is very Important to Include the computation of range and 
bearing angl<^ in the area navigation software because calculations of 
other RNAV information requires range and bearing angle, factors. Range 
and bearing angle errors, especially, are very critical for a ground 
speed calculation because the ground speed calculation deals with small 
range and bearing differences. This will be discussed in more detail 
later on in the chapter. 

A. Range and Bearing Angle . 

The computation of range and bearing angle between two points on 
earth is not simple because the shape of the earth is an irregular el- 
lipsoid, as was mentioned in the previous chapter. It is not necessary 
to perform exact calculations, but there is a certain accuracy v;hich is 
mandated for practical area navigation. On the other hand, the capacity 
of memory and execution time for the microcomputer must be adequate for 
the microprocessor-based Loran-C receiver. 

In the previous work by Fischer, his software provides range 
bearing angle using a simplified elliptical model after the TD-to- 
positlon conversion. Three mathematical models including the simplified 
elliptical model are coir pared for range/ bearing angle calculations to 
determine which model is suitable for RNAV calculations. 

Spharlcal model . If the earth is considered a perfect 
sphere, the spherical model is the proper model for the calculation of 
range/bearing angle between two points on the earth. The great-circle 
calculations are used for this model. 

Referring to figure 4-1, R and W are two points on the earth's 
surface; R is the receiver point and W is the waypoint. The angles X 
and Y at R and W of the great circle passing through the two places and 
the distance D between R and W along the great circle can be calculated 
as follows [28] ; 

From Napier's Anglogier: 

8ini/2(<t>^j-(t)j^) 

tanl/i(Y-X) “ tanV2AX cosl/^((J)^j+(J)j^) 

and 


tanl/ 2 <Y+X) 


cosV2(<{>w“<j)R) 
tan V2AX sinl/2 C 


(4-2) 



where (Ji^^ “ the latitude of the receiver. 

“ the latitude of the waypoint* 

Aa = the difference of longitude between the 
receiver and the waypoint. 
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The bearing angle X is found using (4-1) and (4-2), 
X * 1/2 (Y+X) - 1/2 (Y-X) 


tan 


cosl/2(<fi^^-4)j^) 


tan 1 / 2 AX sin 1/2 ( (j) tan I/ 2 AX cos I /2 ( 4 , 


-1 


sinl/2(.<>j^-(j,j^) 


The distance D (in nautical miles) along the great circle between R and 
W is given as follows; 


tanl/^d = 


tanly^ sinl/2 ( Y+X) 

8inl/2(Y-X) 


D « d X 60*0 (in nautical miles) 


2. Simplified Elliptical Kodel . The simplified elliptical 
model which was applied in Fischer's software might be one of the com- 
promise solutions for the range/bearing angle computations. This model 
uses mid- latitude approximation. Suppose the earth is approximated by 
an ellipsoid with major (equatorial) radius, a=3443.9174 nm, and minor 
(polar) radius, b=3432.3707 nm. The radius of curvature of the earth, 

R, may be computed for the mid-region of the coverage for the particular 
Loran-C stations. Referring to figure 4-2 [29] , and (f,^ are same as 
the previous model, and and are the longitude of the receiver and 
the waypoint [30] . The bearing angle to the waypoint can be calculated 
as follows: 


B - tan 


-1 


(X^-X^)co8(- 






R 


and the distance to the waypoint is; 


D ^ R 


/( 




(Xjj^-Xy) cos ( — ^ 


R is computed with mid-latitude approximation and is stored as a con- 
stant number. R is calculated after choosing the midpoint of the 
coverage region: 

2 2 2 2 
a sin (j)jj + b cos (j)j^ 


where (j)^ Is the latitude of the midpoint. 
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3. Elliptical Model, The elliptical model can be expected to 
be the model which provides more accurate data. The calculations of 
this model are more complicated than other models. 

This elliptical model projects the point on the ellipsoid onto 
the sphere circumscribing the elliptical earth model, because the coor- 
dinate system uses the sherical earth model. After points are pro- 
jected onto the sphere whose radius is the earth's major equatorial 
radius, a, oblique triangle equations are used. For the range computa- 
tion, the difference between an arc on the sphere and an arc on the 
ellipsoid is considered [31 j* Figure 4-3 shows that the point on the 
sphere has a parametric latitude by projecting the latitude of a point 
on the earth onto the sphere, and AX are defined as before. The 

parametric latitude is defined as: 

tan = (l-f)tan(})j^ 

tan = (l-f)tan<|,^^ 

where f = (a-b)/b = 0.00335278 ; the flattening of the ellipsoid. 
The generalized direction cosines of the projected point are: 

Cl = cos3ySin(AX) 

C2 = cos^j^sing^^ - sin3g^cosg^^-cos(AX) 

C3 = sinpj^sinp^ + cosgj^cosg^jCosCAX) 

The bearing angle at the receiver of the geodesic arc from receiver to 
waypoint, measured from north, is (figure 4-4): 

^ . Cl 

tan4, » ^ 

The approximate angle from receiver to waypoint, in a plane through the 
center of the ellipsoid is: 

„ _ C2cosii) + Clsimi; 
tane 

The geodesic arc length between the receiver and the waypoint can be 
calculated as follows: 

£ 

D = a[e - - 5 <mu + nv) ] 


where m = (sinPj^ + slng^^) 
sinPj^ - sin3^^ 


n = [ 


sine 
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Figure 4-3. Circumscribing Sphere Around the Elliptical 
Earth Model . 
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Figure 4-4* FItiptlebI Model. 
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K 9 sine 
sine 
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4 . Comparison Among Three Models . There are three factors 
concerning the comparison, such as accuracy, computation time and memory 
capacity. 

The accuracies of the three models are shown in figure 4-5 (and 
numerically in table 4-1). The data (coordinates, range/bearing) of 
numbers 1 to 5 were taken from reference [32], and the data of numbers 6 
to 9 were. taken frpm reference [33]. These data are known to. have high 
accuracy (much less than O.OOOSnm error). The results Were computed 
using a Fortran-IV program (appendix B) on an 1BM4341. As the figure 
shows, the accuracy of the elliptical model is much better than two 
other models. The errors from ,the model are less than 0.013nm (about 79 
feet), even. the distance between the receiver and the waypoint becomes 
greater than 500nm. The simplified elfiptical model and the spherical 
model have enough accuracies for an area navigation application. Com- 
paring the 'two models,* the simplified model shows better accuracy on 
range computation, and the spherical model shows batter accuracy on 
bearing computation. 

Execution time depends on numbers of mathematical operations, 
especially since trigonometric functions consume. much computer time. 
Table 4-2 shows the numbers of mathematical operations in each model. 

The simplified elliptical model .needs the least execution time among the 
three, and the elliptical model needs' much more execution time than the 
other two. An amount of memory space is directly proportional to execu- 
tion time in thia case. . 

fi 5 

I 

Choosing an optimum model among them depends mostly on the type 
of receiver. The elliptical model is applied to the Ohio University 
receiver because the execution time and the amount of memory space can 
accept this model and the accuracy is great with respect to the ground 
speed calculation, 

B . Other Navigational Information . 

1. Cross-Track Error. It is very Important for a pilot to 
know whether the aircraft is on course or not. If it is off course, by 
how much? Cross-track error (CTE) indicates the position error measured 
on the perpendicular from the desired track to the actual position of 
the aircraft, and cross-track error bearing (CTEB) indicates the angular 
difference between the desired track and actual track (figure 4-6). 

Since the error of the spherical model is small for short distances, the 
spherical trigonometry is adequate for the CTE calculation which pro- 
vides small distances (generally less than lOnm) . CTE can be calculated 
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(a) mean error (b) standard deviation 

A . Range (nm) 



B. Bearing Angle (degree) 


Figure 4-5. Accuracy Comparison among Three Models, 
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Table 4-1 . Numerical Comparison Among Three Models (Fortran Simulatio^>) 
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Type of 
Model 

Operati 

Spherical 

Simplified 

Elliptical 

Elliptical 

Addition 

and 

Subtraction 

4 

4 

12 

Multiplication/ 

Division 

and 

Square Root 

11 

7 

18 

Trigonometric 

Function 

10 

2 

16 


■ " •r>' «r ' • ■■ " I' '■! ■! If I ^ 


Table 4-2. Number of MaffiemaHcaf Operations in each Model. 
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as follows; 
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Since waypoint 2, the aircraft position and point P form a right spheri- 
cal triangle, 


sin a = sin c sin a 


. CTE 

where a = — ^ 


_ Range 


a = CTEB 


where r is a midpoint radius between utrplane and waypoint . 




r == /a^cos^Sj^ + b^sin^Sj^ 

‘i’l + h 


= tan“^ [d-f)tan(j)j^] 

(|)^ and (^2 the latitude of wayf>oin ts, 1 ^ d 2 respectively, r may be 

set as a constant n'^sUer such as r= /a + b = 3438.1489 for the computer 
use because of the sffiall-angle approximation. 

Cross-track error includes airborne equipment, ground equipment, 
and flight technical error (FTE) . 


2. Ground Speed and Estimated lime of Arrival . Theoretically, 
the calculation for ground speed (GS) between two points is simple. 
Figure 4-7 is the diagram used to determine the ground speed calcula- 
tion. 


GS 


= / (Rang 


2 2 2 
e Difference) +(Bearing Difference) Range 


Cycle Time 


(4-3) 


However, as an application for Loran-C area navigation, the com- 
putation cycle is about one and one-half second, and range difference is 
less chan O.lnm, so that a small range error causes a large ground ‘speed 
error. For example, if the range error is O.lnm per 1.5 second then the 
ground speed error becomes 240nm/hour. Since time differences (TDs) 
have random noise errors, an accurate ground speed cannot be obtained 
by simply using equation (4-3) . To solve this problem, two processes 
are made; process 1 calculates the GS using the present point and a 
point which occurred sixteen cycles previously, then uses a recursive 
filter (a-p filter) on the calculated GSc Process., 2 uses the same filter 
on TD values and calculates GS between the present point and a point 
which occurred four cycles previously. The flowcharts of the two pro- 
cesses are shown in figure 4-8. 

Process 1 computes GS after sixteen data points are collected in 
a memory cable, and replaces the old data of the 16 cycles by the present 
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Figure 4-8. Process-1 (One a-p filter) and Process-2 (two a-p 
filters) for Ground Speed Calculation. 












data. Computing the GS between the present point and the oldest 16 
cycles just minimizes the random noise errors. More cycles might reduce 
‘random noise errors; however, they consume more memory space and cause 
large errors on turns because the distance between a straight line and a 
curved line' becomes larger. In order to eliminate random errors, the 
recursive filter loop [34] is added after the GS computation. This 
filter is a valuable aid in data smoothing and prediction, and is easily 
implemented on a microprocessor system. 

Initial condltlori(n=0) is: 

ACP(O) ==0 
GSP(l) = GSO(O) 

Inside the loop(n>l): 

GSS(n) = GSP(n) + a[GS0(n) - GSP(n)] 

ACS(n) = ACP(n) + S[GSO(n) - GSP(n)]/T 
GS(n) GSS(n) + T ACS(n) 


For the next calculation; 
GSP(n-K) = GS(n) 
ACP(n+l) = ACS(n) 


where GSP is predicted ground speed 

GSO is ground speed observed by Loran-C receiver 
GSS is smoothed ground speed 
j AGP is predicted acceleration 
AGS is smoothed acceleration 
a is first-’order gain , 

' ' 3 is 'second-order gain 

- , ■ T is period of loop 


To determine values of a and 3 , a damping ratio p and an effec- 
tive time T^ should be considered. 

A damping ratio p; 



For a compromise between rise time, overshoot, and ringing of the tran- 
sient response unity damping p=l was chosen. 




0.72T 

a 



An effective time decides the response time. The step response becomes 
within e~*^(13.5%) of the final value at t-2T^. Random errors can be 
eliminated when the effective time becomes greater than 30 seconds 
(a=0.033, 3=0.00028) for the Ohio University Loran-G use. This long 
effective time and each 16-cycle old data vdiich is used for the GS 
calculation makes the GS response too slow for aircraft speed. 


Process 2 was made to speed up the slow response. This process 
uses the same filter twice on TD values and GS. Although TD values hav^ 
a hyperbolic geometry, a small TD change (less than 1 microsecond per 
cycle) can be considered a linear change. The purpose of filtering on 
TDs minimizes random errors on position information and avoids a long 
response time of the filter on calculated GS. Also, four cycles are 
used instead of sixteen cycles for the GS calculation to reduce errors 
on turns. The effective time of the filter on TDs should be short 
enough to provide adequate response for positipn information. The 
T^=«6sec.(a=0.167 , 3=0.007) on TD valueo and Tj»12sec.(a*0 .08 , 3*0.0017) 
on GS are chosen for Ohio University Loran-C use. Process 2 also mini** 
mixes memory space. Although the response is still slow for accelera- 
ted flight, it is adequate for most flight conditions. 


Estimated time of arrival (ETA) can ba provided after the calcu- 
lations of range and ground speed. The equation is as follows: 




C. A Scheme for Microcomputer Use . 

The area navigation (RNAV) program can be executed after TDs and 
coordinates of position are computed. The program which measures two 
TDs with Loran-C phase-locked loop operation and the other program which 
does TO-to-geographic conversion were already available for the Ohio 
University Loran-C [35,36], For the ground speed computation, an a~3 
filter was added to the TD-to-geographic conversion program. The floif 
chart of these programs is shown in figure 4-9. These three programs 
form a loop to provide navigation outputs every short period of time 
GRIxl4 , (about 1 .4 second when GRI=9960jiS) . The TD measurement program 
is the main program and jumps to subprogram 1 (the TD-to-geographic 
program) after two TDs are measured. The TD-to-geographic program 
calculates the coordinates of the position by reading two TDs and con- 
tinuing to subprogram 2 (RNAV program) . The RNAV program gets input 
data from the TD-togeographic program (coordinates of the position) and 
other input data from the user (coordinates of the waypoints) and calcu- 
lates RNAV informations. 

Since the RNAV provides a cross-track error, the desired course 
is calculated first, and then the GS calculation starts four cycles 
after the cross-track error calculation, because the GS calculatlpn has 
a four-cycle interval. More detail will be shown in the next chapter. 
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Main Program 


Subprogram 1 


Subprogram 2 



Figure 4-9. Flowchart of Navigation Program for Ohio University Loran-C Receiver 
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V 


THE MICROCOMPUTER SYSTEM 


Ao System Desiga * 

The navigation programs are software additions for the microcom- 
puter-based Loran-C receiver. The total system design is the main con- 
straint for the design of the software. 

^ • Hardware . The configuration in figure 5-1 shows that the 
receiver utilizes a whip antenna, a wide-band preamplifier/coupler , an 
ACC processor, an RF frond-end processor and tracking loop hardware/ 
Software to receive Loran-C signals and to measure TDs [37]. The MOS 
Technology 6502 Super-Jolt does all of the microprocessor work. The 
software is written in 6502 assembler language (figure 5-2 [38]), A 
pilot enters control functions and input data to the receiver from the 
panel-mounted keyboard or the hand-held ASCII terminal. All naviga- 
tional information is displayed on the CRT screen for the pilot, and can 
also be recorded on a digital cassette unit for data reduction purposes. 

The TD-to-position and RNAV calculations require a numerical 
range of approximately 10"“^ to 10^, therefore, it is necesary to use a 
floating-point format. Besides, these calculations involve multi- 
precision addition, subtraction, multiplication, division and trigono- 
metric functions. The 6502 microprocessor has only an 8-bit data bus, 
so that the processor needs a large amount of memory and rapid access. 
For many applications of the microprocessor, including the Loran-C 
application, the access time and memory amount are limited, therefore, 
it is desired to use an external device to support the microprocessor 
for these calculations. 

The Am9511A by Advanced Micro Devices is a peripheral tBathematics 
processor which does the necessary floating-point calculations. It is 
designed to be used in microprocessor systems which have an eight-bit 
data bus. It can handle 16-bit and 32-bit fixed point arithmetic, 

32-bit floating-point arithmetic and trigonometric functions using a 
stack-oriented operand storage (sixteen 8-bit words). Hence, this de- 
vice can provide useful support for the microprocessor's calculations. 

A listing of the instruction set for the Ara9511A is shown in figure 5-3 
[39]. 


To interface the Am9511A to the Jolt microcomputer system, it is 
necessary to use additional hardware in order to handle device selec- 
tion and data transfer. An M6820 peripheral interface adapter(PIA) is 
used as the additional hardware for the hand-shaking between the Jolt 
and the 9511. The M6820 consists of two eight-bit ports and several 
other registers used to interface to peripheral devices. The overall 
design of the microcomputer system is shown in figure 5-4 • 

2. Interfacing Software . Particular software is required in order 
to initialize the hardware interface and the 9511, to write a single 
floating-point (32-bit) number, to read a floating-point (32-bit) number. 
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Figure 5-1 . Block Diagram of ToKil System Ohio University Loran-C Receiver. 
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ADC 

Add with carry 

JSR 

Jump to subroutine 

AND 

Logical AND 

LDA 

Load accumulator 

ASL 

Arithmetic shift left 

LDX 

Load X 

BCC 

Branch if carry clear 

LDY 

Load Y 

DCS 

Branch if carry set 

LSR 

Logical shift right 

BCQ 

Branch if result = 0 

NOP 

No operation 

BIT 

Test bit 

ORA 

Logical OR 

BMI 

Branch if minus 

PHA 

Push A 

BNE 

Branch if not equal to 0 

PHP 

Push P status . 

BPL 

Branch if plus 

PLA 

Pull A 

BRK 

Break 

PLP 

Pull P statu.s 

BVC 

Branch if overflow clear 

ROL 

Rotate left 

BVS 

Branch if overflow set 

ROR 

Rotate right 

CLC 

Clear carry 

RTI 

Return'from interrupt 

CLD 

•.Clear decimal flag 

RTS 

Return from subroutine 

CLI 

Clear interrupt disable 

SBC 

Subtract with carry , 

CLV 

Clear overflow 

SEC 

Set carry 

CMP 

Compare to accumulator 

SED 

Set decimal 

CPX 

Compare to X 

SEI 

Set interrupt disable 

CPY 

Compare to Y 

STA ■ ■ 

Store accumulator 

DEC 

Decrement memory 

STX 

Store X 

DEX 

Decrement X 

STY 

Store Y 

DEY 

Decrement Y 

TAX 

TVansfer A to X 

EOR 

Exclusive OR 

TAY 

TVansfer A to Y 

INC 

Increment memory 

TSX 

TransferSP to X 

INX 

Increment X 

TXA 

TVansfer X to A 

INY 

Increment Y 

TXS 

TVansfer X to SP 

JMP 

Jump 

TYA 

TVansfer Y to A 


Figure 5-2. Instruction Set of MOS Technology 6502, 
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1 Command 
• Mnamonlc 

N«x Coda 
(nr « 1) 

H«x Cod* 
<w « •) 

Exfcution 

Cyct** 

Summaiy 

1 i*-Brr FixEO.»>otHT ofefiATjon* I 

j SADD 

EC 

ec 

16'19 

Add T03 10 NOS. FN(UH to NOS. Pop SUi:li. 

j ssue 

ED 

«0 

3(P32 

Suotrtct TOS Inim NOS, FtatuR io NOS, Pop Suck. 

I SMUL 

£E 

5E 

94'94 

MiitiplT NOS *77 TOS. Low«r raiuH to NOS. Pop Suck. 

, SMUU 

F6 

76 

9096 

Multiply NOS by TOS. Upiur it»M to NOS. Pop SUck. 

. SDiV 

EF 

6F 

94-94 

DMito NOS by TOS. IWwK to NOS. Pop Suck. 

' M'BIT nXED-BOMT OIMERATIOMS j 

1 OAOO 

AC 

2C 

20-22 

Add TOS to NOS. Rawit to NOS, Pop Suck. 

1 osue 

AO 

20 

36-40 

Sublfpct TOS trom NOS. ftotuft lo NOS. Pop Suck. 

i OMUL 

AE 

2E 

194-210 

Multiply NOS by TOS. Lo«r«r utult to NOS, Pop SUek. 

‘ OMUU 

B6 

36 

162-218 

Mulliply NOS by TOS Uppor itttM to NOS. Pop Stock. 

‘ DOIV 

AF 

2F 

196-210 

Divid* NOS by TOS. Ftotuk to NOS, Pop SUck. 

32-»rT FLOATIHQ-POINT WWMAHY OPCaATlOMS | 

J FAOO 

W 

10 

54-30a 

Add TOS to NOS. RotUI to NOS. Pop Stock. 

Fsue 

•1 

H 

70-370 

Subtract TOS lioni NOS, ItoMlt to NOS, Pop Stock. 

FMUl 

•2 

12 

146-166 

Multiply NOS by TOS. Rouilt to NOS. Pop Stodi. 

1 roiv 

n 

13 

194-164 

Dfvkl* NOS by TOS. HoujK to NOS. Pop Stock. 

1 32-wrFLOA1W*a-KWrrDCmVEDOMEnATK>NS 1 

' SOBT 

•1 

01 

792-970 

Squen ftoot ot TOS. Itofrit to TOS. 

! SIN 

■2 

02 

3796-4906 

Skto ol TOS. Roiult to TOS. 

; cos 

•3 

03 

364O-M70 

Co«in* o( TOS. Rewxt to TOS. 

, TAN 

•4 

04 

4694-5686 

TanowX of TOS. Nacult to TOS. 

ASIN 

•S 

06 

6230-7936 

lovwM Stoc of TOS. Ftosuh to TOS. 

' ACOS 

M 

0* 

6304-6264 

InvaiM Coskto ol TOS. RosuH to TOS. 

j AtAN 


07 

4992-6536 

Wwore* T*ng4« of TOS. ftosufl !e TOS, 

; LOG 

H 

Of 

4474-7132 

Common LopaiMhm of TOS. (totUI to TOS. 

! I-N 

N 

09 

4296-6956 

Natural logarithm of TOS. Ratult to TOS. 

EXP 

•A 

OA 

3794-4876 

* taiMd to p(ww In TOS. Ftowlt to TOS. 

1 PWH 

W 

08 

8290-12032 

NOS rakud to pa««r in TOS, Patult to NOS. Pop Stock. 

' DATA AND STACK MAMPULATIQN OPCRATIOHS | 

NOP 

•0 

00 

'■< 

No Oparation. Claar or aat SVREO, 

• PIXS 


IF 

90-214) 


PIXO 

9E 

IE 

90-336/ 

Convad TOS tnxn Itoaling point lornul to fixed point formal. 

PLTS 

90 

10 

62-156 ) 


FLTO 

»C 

1C 

56-342 / 

Convan TOS from fixed pom! format to Itoatmg potnl tormat. 

CHSS 

F« 

74 

22'24 ) 


CMSD 

B4 

M 

26-26 / 

Chang* Ngn of fixed point operand on TOS, 

CHSF 

ts 

15 

16-20 

Change sign of floating point operand on TOS, 

PTOS 

FT 

77 

16) 


PTOO 

B7 

37 

20 > 

Push suck. Duplicale NOS m TOS 

PTOF 

97 

17 

20 j 


POPS 

Fa 

7« 

10) 


POPO 

a* 

39 

12 > 

Pop slack. Old NOS becomes new TOS. Old TOS roUles to boRom. 

POPF 

96 

19 

12 ; 


XCHS 

F8 

79 

16) 


XCHO 

89 

39 

26} 

Exchange TOS and NOS 

XCHF 

99 

19 

26 ) 


PUPI 

BA 

1A 

16 

Push hosbng pcoil oonsunl ir onto TOS Previous TOS tlacornes NOS. 


Figure 5-3. InsIrucHon Set of Am95n A. 
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Figure 5-4. Block Diogrom of Microcomputer Navigotionai System. 









to send an eight-bit word to the 9511 representing a command to be exe- 
cuted, and to read the 9511 eight-bit status register. Four subroutines 
were developed for the interface by Fischer. 

These four subroutines are: "PINT'', "PUSH", "POP” and "v.MND". 
"PINT" initializes the M6820 & PIA and also initializes RAM locations 
for the scratch-pad use. "PUSH" is used to copy a four-byte number from 
read/write memory onto the stack of the 9511, and "POP" is used to do 
the opposite. "CMND" is used to command the 9511 to perform a given 
function. A part of the "CMND" subroutine checks the status register to 
determine the final outcome of the completed command. Figure 5-5 shows 
a set of logic flow diagrams illustrating steps of the central program 
which execute to communicate with the 9511. 

B. Navigational Programs. 


1. Relationships Among Navigational Programs . There are 
three navigational programs for the Loran-C receiver, as was mentioned 
in Chapter IV. The main program "L0RPR0M5" does Loran-C tracking phase- 
locked-loop operation providing two TDs, The execution time of this 
program is ten group repetition intervals (GRI) because the program com- 
putes two TDs per one GRI and calculates each average TD with ten TD 
references. 

After two TDs are calculated, ten GRIs later, the main program 
jumps to subprogram 1, "C00RD2" which filters two TD values and provides 
coordinates of the position using a TD-to-position conversion. The 
filter included in "C00RD2" is the a-g filter with an effective time 
constant of 6 seconds. This time gives acceptable response for position 
information, considering typical aircraft spe^^ds. 

Subprogram-2, "RNAV", which provides the area navigation infor- 
mation, can be executed after "L0RPR0M5" and "C00RD2" are executed. Two 
sets of input data are needed for subprogram 2; one is the set of coor- 
dinates of position from "C00RD2" and the other is a set of coordinates 
of a selected waypoint from the user's waypoint table. 

The execution time of subprogram "C00RD2" and subprogram "RNAV" 
is three to four GRIs depending upon the content of the calculation. 
After the execution of "RNAV", the program process goes back to the main 
program "L0RPR0M5" and repeats the same process. Hence, the outer loop 
Including "LORPROM5", "C00RD2" and "RNAV" forms the Loran-C software to 
provide navigational information, such as TDs, coordinates of aircraft 
position, range and bearing angle, Ci'E/CTEB, GS and ETA, every thirteen 
to fourteen GRIs (every 1.29 to 1.39 seconds at 9960 GRI). Figure 5-6 
shows this scheme for Loran-C navigation software, and figure 5-7 shows 
the address map for these programs. The main program (L0RPR0M5) is 
placed on 2K erasable, programmable, read-only memory (EPROM). The 
subprogram (C00RD2 and RNAV) is placed on three 2K EPROM and uses two 
pages (256 byte par page) of general xead/write storage for results of 
intermediate calculations. The page zero (in RAM) is for temporary 
variables and flags. 


PINT 
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PUSH 



POP 



Set PIA side-A to 
outputs 


Set count of 
four 


Lood 8 bits 
of numbers 


Send to 951 1 via 
PIA side-A 

-- - ^ 

Set WR and C/D low on] 
951 1 via PIA side-B 


Set WR high on 
9511 


NO 


Decrement count 


Ccunt - 0? 


y ts 


END 


Figure 5-5. Logic Flow Diagrams 
Illustrating Steps 
Control Program 
Executes to Communi- 
cate With 951 1 , C40H 
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SET PI A SIDE-A 
TO OUTPUTS 
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SEND 8-BIT COMMAND TO 
9511 VIA PIA SIDE-A 


SET C/D HIGH, 
WR LOW 


WAIT FOR END 
TO COME HIGH 


SET PIA SIDE-A 
TO INPUTS 


SET C/D HIGH, 
RD LOW 


WAIT FOR PAUSE 
TO COME HIGH 


GET 8-BIT STATUS FROM 
9511 VIA PIA SIDE-A 


DISABLE 951 1 


Figure 5-5. Continued, 
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2. RNAV Program . The RNAV program Is the main subject of 
this paper. Figure 5-8 shows the flow chart of the whole program. 

There are four parts in this program. 

The first part of the RNAV program takes care of finding selected 
waypoints from the tiser's waypoint table, displaying waypoint numbers 
and converting the degree-minute-second format (BCD) to the floating- 
point format in radian units. 

The flow chart for the waypoint conversion is shown in figure 
5-9. The coordinates of the waypoints and desired waypoint numbers are 
input to the waypoint table from the keyboard by the user. The input 
has a certain format in the waypoint table as a part of figure 5-10 
Indicates. Since the 9511 is used for calculations, it Is necessary to 
convert each element for navigational calculations into 32-^bit floating- 
point format. 

An example of waypoint conversion is shown in figure S'^IO. Sup-^" 
pose the user chooses waypoint No. 3 whose latitude is 125® 53’ 41". A 
four-byte waypoint register, three-byte temporary register and accumula- 
tor are used for this conversion, and the final result is stored into 
the four-byte waypoint register. One of the commands available with 
the 9511 is to convert a fixed-point (Integer) number to floating-point 
(step 14 in figure 5-10). The fixed-point number must be in binary 
because it is not possible to represent a fraction using this command. 
Therefore, step 14 must come before step 15. This waypoint conversion 
is not repeated until the user changes waypoint numbers for a desired 
course change. 

The second part of the RNAV program calculates range and bearing 
angle. For the first loop, which Includes all programs (L0RPR0M5, 

C00RD2 and RNAV) after the user chooses the desired waypoints, this part 
calculates range and bearing angle of the desired course. From the 
second loop, it starts calculating range and bearing angle between the 
position of the aircraft and a TO waypoint. 

After range and bearing angle are calculated, the third part 
calculates CTEB and GTE. 

Calculation of CTEB is as follows: 

CTEB = (Present Bearing Angle) 

-(Bearing Angle of The Desired Course) 

However, when the calculation Includes a transition between 0° 
and 360°, a certain correction is necessary. For example, when a pre- 
sent bearing angle is 358° and a bearing angle of the desired course is 
1°, the CTEB becomes 357°. The resultant number, which should be 3°, 
can be obtained by subtracting this CTEB of 357° frpm 360°. 

It is very convenient for the software to show whether the course 
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Return to the Main 
Program 


Figure 5-8. Flow Chart of RNAV Program. 
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Main Program 








Get MSD 


. MSD=I? 


X Yes 


Add 64 (HEX) to Contents 




Increment Index to Point to Digit 
in order of Decreasing Significonc 



Get Number Pointed at by Index 


Get u 


(upper digit) x 10->WPT register 



Get lower digit 


Add contents of WPT register 


WPT Register 4- WPT Register + 
Temp. Register 


Least significani 
digit? ^ 


Temp. Register 4-WPT register x 60 


Cleor Temp. Register 


Convert from fixed-point 
format into floating-pt. format 


WPT Register -r 3600 


Convert into radian unit 


Figure 5-9. Flow Chart of Waypoint Conversion 
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MSD > 


Inside Waypoint Table 
All digits are BCD 


Waypoint no. I vl/ 

Latitude i 
(4 byte) 11^ 

wpt, no. — ' 

_ LongtitudeV 

(4Lyte) 1^ 
don't care — 
Waypoint no. 2j — , — 

Latitude 2 


V ■ — ■ 

degree 


degree 



minute 


minute 


second 


second 



Inside Waypoint 
Register 

32 -bit floating- 
point 


Conversion • • • • 



• • • • 4 bits (upper digit) +4 bits (lower digit) 



Figure 5-10. Steps of Waypoint Conversion . 
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Waypoint No. 3 125“ 53’ 41" (Latitude) 





is to the left or to the right. When the CTEB is between 0° and 90°, 
the desired course is on the right-side of the airplane, but if the CTEB 
is between -90° and 0°, then the course is on the opposite (left) side 
of the airplane. Furthermore, the magnitude of the CTEB exceeds 90° 
after the airplane passes the To waypoint. In order to find the side of 
the desired course from any airplane position, the procedure in figure 
5-il was added inside the CTEB calculation routine. Letters “L" and "R" 
are added to the front of the CTEB display. 

The CDI (Course Deviation Indicatar) shows the CTE value 
visually. A zero center is the desired course, and a needle shows GTE 
(FTE). The Ohio University Loran-C display uses a video board, so that 
a graphic display is possible. In the program, a position register is 
set according to a CTE value (see figure 5-12) . 

The last part of RNAV takes care of the ground speed calculation 
(figure 5-13) and estimated time of arrival at the waypoint. Since 
ground speed fluctuates due to any kind of position error, the ground 
speed calculation needs some delay so that TD values become stable. 
Usually, TD values need several computation cycles to become stable 
after the receiver starts tracking Loran-C signals. The 32 loops delay 
after the first TD measurement was added between the third part and the 
last part to eliminate the TD transition errors. 

After calculating GS, the ground speed goes through a recursive 
filter loop, as was discussed in Chapter IV. The effective time of the 
a-g filter for ground speed (12 seconds) , gives the fastest response 
without conspicuously noisy data. However, the ground speed has a ran- 
dom noise error range of zero to 30 knot(=»nm/hour) when the receiver is 
at a fixed position; therefore, the display indicates zero ground if the 
speed is below 30 knots. Although this response is still slow for acce- 
lerated flight, it is reasonable for a constant ground speed flight. 

All navigational information are displayed on a CRT screen. 

Figure 5-14 shows a Loran-C receiver display. To display information on 
the screen, all data must be converted from floating-point format to 
BCD. A subroutine now available for this conversion was developed by 
Fischer. 

The complete microprocessor program for area navigation is shown 
in appendix C. This pfogram occupies 2064 bytes of EPROM-2716 and 400 
bytes of read/write nemory for scratch calculations, a waypoint table 
and a reference table for GS averaging. Total RNAV calculations require 
about 0.20 second to complete with the AM9511A and the 6502 running at a 
clock speed of IMHz. Figure 5-15 is a photograph of the Loran-C 
receiver developed by the Ohio University Avionics Engineering Center, 
The efficacy of the R1^AV program was checked using this receiver. 
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Figure 5^11 ^ Flow Chart of Cross-Track Error and Cross-Track Error Bearing, 













Figure 5-12, CDI Display. 
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Figure 5-13. Flow Chart of Ground Speed. 
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VI. TESTS WITH MICROCOMPUTER IN AREA NAVIGATION APPLICATION 

A verification of the performance capabilities of area navivation 
was examined by testing with simulations and flight testing. Accuracy 
and operational stability of the system were the focus of the testing. 

A. Testing with Simulations . 

Accuracy checks were accomplished by picking random locations on 
the earth, including some locations inside the northeast U.S, Loran-C 
chain because the following flight testing was performed in this chain. 
Coordinates of each point were stored in random access memory either as 
a receiver position or as a waypoint, then the range/bearing calculation 
routine was executed. Table 6-1 is the result, comparing the actual 
range to the waypoint and bearing to true north, as calculated using the 
elliptical model. The accuracy is consistent with the Fortran simula- 
tion using the IBM4341 computer (Chapter IV. A. 4). 

After testing the accuracy of the range/bearing calculation, 
other testing to check the CTE/CTEB calculation routine was made. As 
figure 6-1 shows, two desired courses were set for this test; one is 
from waypoint 2 to waypoint 1 and the other is from waypoint 3 to 
waypoint 1^ and points A, B and C are observed points with respect to 
the desired course from wpt2 to wptl, point D, E and F are observed 
points with respect to the desired course from wpt3 to wptl = All 
observed points are in the northeast U.S. chain. The coordinates of 
each point were stored in random access memory and the RNAV program was 
excuted without the other programs (LORPROM5 and C00RD2). Table 6-2 
indicates the results of this test which are indicated with 10”^ reso- 
lution on the CRT screen (figure 5-14). The numbers in this table are 
comparisons with the results of the receiver RNAV program, and those 
calculated by the Fortran program using the elliptical model, since the 
high accuracy of the elliptical model was demonstrated in table 4-1. 

The correct sense of the CTE/CTEB display including the effects of 
ground track To or From waypoint computed by the CTE/CTEB calculation 
routine were verified by this test. 

The ground speed calculation was tested by a simulation program 
which created a moving observation point; however, it was difficult to 
simulate these computational results without actual flights with random 
noise. For evaluating the ground speed computation, the flight test was 
necessary. 

Moreover, the total program software (L0RPR0M5 + C00RD2 + RNAV) 
was tested by using a Loran-C simulator manufactured by Epsco Inc. As 
a result of this testing, the bias errors were determined to be due to 
signal strengths for reception of Loran-C stations in the local area 
[41], and the I' -to-Georaetric conversion. The simulator produced essen- 
tially no noise. 
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N.LAT/W.LONG 

To 

Waypoint 

N.LAT/W.LONG 

Range/Bear 

(nm/degree) 


Microcomputer RNAV 

Range/Bear 

nm/degree 

Error of 
Range/Bear 

1 

40 

30 

37.8 

40 

00 

0.0 

43.448 


^>^448 

0.0 


17 

19 

43.3 

18 

00 

0.0 

225 .43 


22^.39 

0.04 
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9 

59 

48.3 

10 

00 

0.0 

86.897 
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16 

31 
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18 

00 

0.0 

270.26 


270.25 


3 

69 

48 
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70 

00 

0.0 

173.794 


173.788 

0.006 


9 

37 

28.6 

18 

00 

0.0 

277.87 
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0.01 

4 

13 

04 

12.6 

10 

00 

0.0 

260.690 


260.697 

0.007 


14 

51 

13.3 

18 

00 

0.0 

225.63 


225.55 

0.08 

5- 

73 

35 

9.2 

70 

00 

0.0 

347.588 


347.576 

0.012 


3 

26 

35.1 

18 

00 

0.0 

238.84 


238.84 

0.0 

6 

42 

42 

50.6 

41 

15 

11.9 

318.621 


318,619 

0.002 


76 

49 

33.9 

69 

58 

39.1 

103.57 


103.68 

0.09 

7 

42 

42 

50.6 

46 

48 

27.2 

452.416 


452.410 

0.006 


76 

49 

,33.9 

67 

55 

37.7 

54.05 


54.04 

0.01 

8 

42 

42 

50.6 

39 

51 

7.5 

511.412 


511.409 

0.003 


76 

49 

33.9 

87 

29 

12.1 

253.91 


253.95 

0.04 

9 

42 

42 

50.6 

34 

03 

46.0 

521.045 


521.052 

0.007 


76 

49 

33.9 

77 

54 

46.8 

185.92 


185.97 

0.05 


Table 6-1. Accuracy of Microcomputer Range/Bearing 
Computation with Elliptical Model. 
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Table 6-2. Test Result of Area Navigation Computation 
Using Fixed Time Differences 
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B. Flight Testing . 

The purpose of the flight testing is to prove the effectiveness 
of the area navigation system for an actual flight. The filtering of 
time differences to smooth the raw data, filtering the ground speed to 
reduce random noise, range/ bearing, CTE/CTEB and CDI indication were 
verified during the flight test. 

Nineteen flight test paths, whose time length varied between 10 
minutes to 20 minutes in a Piper Cherokee were flown with a total flight 
time of approximately 5 hours. Two flight tracks are shown in this 
paper. Figures 6-2 to 6-8 are from flight test 1 and figures 6-9 to 
6-19 are from flight test 2. 


1. Filtering time differences . For flight test 1 (figure 
6-2) , the pilot tracked from the Ohio University airport runway 25 (RVTi 
25) threshold, made a left 180® turn, tracking right of the desired 
course (from the BIAS NDB to the BIAS BWY 25 TRESH) , made a left 180° 
turn again, passed above the NDB, making two loops around the NDB, 
tracking back to the RWY 25 threshold using an instrument landing system 
(ILS) localizer on RWY 25. 

The filtered TD flight path of flight test 1 is shown in figure 
6-2, and the nonfiltered TD flight path simulated by the Fortran program 
(appendix D) is shown in figure 6-3. As indicated by the comparison, 
about tO.lnm random noise was detected with the error caused by the time 
delay on turns about O.lnm. The bias error was measured about 0.7nm to 
the north. Figure 6-4 is the output simulated by the Fortran program 
(appendix E) which shows very nearly the same flight path as in figure 
6-2; therefore, the Fortran simulation can be used for data analysis. 


After 14 flight test paths were recorded, the IMHz clock (which 
is used for the 6502 and the AM9511A), showed some instability, so 5 
additional flight tests were made with a new stable clock. 


For flight test 2 with the stable clock (figure 6-9), the pilot 
flew very similar patterns as in flight test 1, but after passing the 
NDB the pilot made one race track pattern and returned to the RWY 25 
threshold . The coordinates of the two waypoints (Rwy 25 threshold and 
UNI NPB) are biased waypoints based on the previous flight tests. The 
flight path was smoother than the previous flight test due to the 
improved stability of the clock. Comparisons between figure 6-9 and 
figure 6-10 indicate the improved raw TD data which has less than tO.lnm 
random noise with the bias reduced to about 0.5nm. Since the old effec- 
tive time constant for the filtered TDs is too long for the TD's, using 
the same clock, the effective filter time constant can be reduced. The 
new time constant of 4 seconds (the previous time constant was 6 seconds) 
is used for the plot in figure 6-11. This reduction of the time constant 
Improved the acceleration effect of turns, furthermore the ground speed 
computation process was speeded up. 


2. Ground speed . The ground speed calculation is affected 
the most by random noise as was mentioned before. Two filters (one on 
TDs and another on GS) to filter the random noise were evaluated. 
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Figures 6-5 through 6-8 plot the ground speed of flight test 1. 
Figure 6-5 is the result of flight test 1 and figure 6-6 is the simu- 
lated data using nonfiltered TDs and nonfiltered GS. In figure 6-6, the 
ground speed indicated 400 knots when the actual speed did not exceed 
150nin/hr. In the comparison between these two figures, the significant 
effect of the two filters is shown. Figure 6-7 indicates the results of 
filtering ground speed alone and figure 6-8 indicates filtering of TDs 
alone, but the best result was obtained by a combination of ground speed 
and TD filtering as indicated by figure 6-5 . 

Figures 6-12 and 6-13 plot the ground speed of flight test 2. 
Although the TDs have less random noise than the TDs of flight test 1 , 
nonfiltered ground speed is not acceptable for RNAV information, 

3. Range/ bearing, CTE/CTEB and GDI Indications , The accuracy 
of the range/bearing calculation and the CTE/CTEB calculation was eval- 
uated by simulation; however, relative accuracy was tested during the 
flight tests. 

Figures 6-14 and 6-15 are plotted using the result of flight 
test 2, and figures 6-16 and 6-17 are plots made by the Fortran simula- 
tion, According to these four figures, relative accuracy of the range/ 
bearing are adequate. Figures 6-18 and 6-19 plot CTE and CTEB during 
the flight, and they are accurate with respect to the desired course. 

However, the CDI indicator produced confusion for the pilot 
because the indicator sViowed the wrong direction to the course whenever 
the airplane was moving with an angle which was more than 90“ to the 
desired course bearing angle (241,19° for flight test-2). A CDI indica- 
tor using a VOR station also causes a similar problem. 

In order to indicate the desired CDI indication, it is necessary 
to determine the flight path vector. Since the Loran-C provides true 
position information, the receiver has the capability to compute a 
flight path vector for providing the correct CDI indication for any 
airplane position. A software routine for computation of a flight path 
vector and the angle difference between the vector angle and desired 
course angle is added to the CTE/CTEB calculation routine. 

The corrected CTE and right/left indication of flight test 2 was 
plotted in figuia 6-20 tjsing the Forrran sim^rlation. The corrected 
CTE/CTEB routine in the RNAV program was tested using the Loran-C simu- 
lator. 


Figure 6-21 is a photogragh of the Ohio University Loran-C 
receiver inside the Piper Cherokee for the flight test. 




Figure 6-13. Ground Speed (Knots) - Time (minute). Flight Test 2 

Fortran Simulation of Ground Speed Using Nonfiltered TDs 
No Filter in Ground Speed Calculation. 
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Figure 6-20. Cross-Track Error (NM) - Time (Minutes) 

Fortran Simulation of Flight Test 2, Right/Left 
Off-course Indication is corrected. 
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Figure 6-21 . Photograph of Ohio University's Loron-C Receiver Inside the Piper 
Cherokee During Flight Testing. 


VII. CONCLUSIONS A^n) RECOMMENDATIONS 

Some specific coacluslons can be reached as a result of the work 
performed in developing a mlctocomputer-based Loran-C receiver for 
general aviation application. 

The objective of this area navigation software implementation is 
to provide high quality air navigation information by using Loran-C as a 
navigation system for general aviation. The following conclusions are 
made according to the test results In Chapter VI. 

The conclusions are: 

1. The high accuracy of the range/ bearing calculation using the 
microcomputer-based Loran-C receiver was demonstrated; the error without 
a bias error does not exceed more than 0.012nm (range) or 0.09“ (bearing) 
for ranges to 530nm, 

2. Operational performance, /as observed on a flight in a general 
aviation aircraft, is obtained using a a~3 filter on time differences to 
reduce random noise. Filtering TDs with the new, stable clock, with an 
effective time constant is 4 seconds, effectively smooths the flight 
path and does not cause serious delay on the turns, 

3. The ground speed calculation with 10 knots resolution has 
operational stability for a constant or low-acceleration flight. Since 
the ground speed calculation process passes through two filters, the 
ground speed cannot be easily updated with high acceleration. According 
to the effective time constants for the two filters (4 seconds for TDs 
and 12 seconds for the GS calculation), a step response becomes 86.3% of 
final value after 24 seconds. So the ground speedy calculation can 
accept an acceleration which is less than 0.13nm/s'^. 

4. The CTE/CTEB indication provides the relative position and 
proper direction respectively to any desired course Inside the Loran-C 
coverage area. Even with an airplane very close to a To waypoint (less 
than O.lnm) the GTE has sufficent sensitivity to calculate an accurate 
GDI indication, while the VOR navigation system at close range is too 
sensitive. 

5. An execution ti®« Si the navigation system routine does 

not exceed more than 1.5 stconds, which is short enough for adequate 
position update information for air navigation. In the northeast U.S. 
chain (GRI=99600ps) , the execution time is about 1,39 seconds for RNAV 
position updates. 

6. The Loran-C navigation system with the new stable clock 
recorded an average bias error of 0.5nm which meets the requirement 
stated in AC90-45A (enroute 2.5nm, terminal 1.5nm). Even for an 
approach, this system has the capability to meet the total error of 
0.6nm stated in AC90-45A. 
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7. The Loran-C area navigation software makes It possible for 
the general aviation user to fly to any point inside the Loran-C cover- 
age area in true area navigation fashion unlike VQR navigation system 
with its line-of-sight and range restrictions, 

Some problems were identified during the testing, and these 
should be addressed and solved prior to implementation by general 
aviation. 


1 . The bias error to the north is due to signal-strength dif- 
ferences of Loran-C stations and Avionics Engineering Center's receiver 
implementation. The bias error can be significantly reduced with a new 
RF front end [42] and applying propagation corrections. The recent 
tests with Che new RF front end indicated a bias error of 0.2nm. These 
data were collected in the same area as the previous flight tests. The 
bias error of 0.2nm could be further reduced with the application of a 
propagation correction. 

2. An improved ground speed response for accelerated flight. 

The ground speed response for accelerated flight can be improved by 
implementing a three dimensional filter [43] j however, improvement of 
measuring time differences to reduce random noise should be made to pro- 
vide better data for ground speed calculations. 

Contemporary microprocesso technology has greatly Improved the 
capability for quality high navigation, and allows for achieving low- 
cost and light V7eight receivers for general aviation applications. This 
RNAV software promises to provide the pilot with significant operational 
advantages through the use of a microcomputer-based Loran-C receiver. 


C-^ 
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APPENDIX A. The computation for an area navigation(RNAV) equipment 
based on the use of VOR/DME. 

8 = e^Ct) - 


Distance » = /p^(t) + p^e - 2pp cospCt) 

eg e 

where 0^ = The angle from true north relating to the 
aircraft 


0^ = The angle from true north relating to the 
VOR/DME station 


p(t) = The distance between the VOR/DME station 
and the aircraft 


p(t) = The distance between the VOR/DME station 
and the waypoint 
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APPENDIX B. Program listing for testing range and bearing angle 
computational models. 

This program was written in standard Fortran IV programming 
language and run in the IBM4341 system at Ohio University. 


C 

C THIS PROGRW^ CALCULATES A DISTANCE AND A BEARING BETWEEN TWO 
C WAYPOINTS . 

C COMPARISON AMONG THREE MODELS(SPHERICAL,SIMPLIFI ED ELLIPTICAL 

C AND ELLIPTICAL) 

C DEVICE 5 IS A INPUT DEVICE 

C DEVICE 6 IS A OUTPUT DEVICE 

C 

C FEBRUARY/1982 F.OGURI 

C 

C 

C LAI=* LATITUDE OF THE RECEIVER 
C LOt= LONGITUDE OF THE RECEIVER 
C 

C LA2= LATITUDE OF THE SECOND POINT 
C L02= LONGITUDE OF THE SECOND POINT 
C 

REAL LAI ,LA2,L01 ,L02,MU,NV,LAA,LAB,LAC,MAB 
C READ COORDINATES OF THE TWO POINTS AND CONVERT GEOCENTRIC 
C COORDINATES TO RADIAN COORDINATES . 

CALL ROLL (LAI, LOl) 

CALL RDLL(LA2,L02) 

C READ RANGE AND BEARING ANGLE TO CALCULATE THE ERROR BETWEEN 
C MEASURED VALUES AND ACTUAL VALUES. 

CALL RABE (RANGE, BEAR) 

DATA A/3443.917387/ 

PI =3, 1415926535898 
C 

C ELLIPTICAL MODEL 

C 

FF=1. -0.00335278 
F=0. 00335278 
A=3443.917397 
8=3432.370680 
DLO=L01-L02 
TB=FF*TAN(LAI) 

TBI=FF»TAN(LA2) 

CB=SQRT(1.+TB»*2) 

CBI=S0RT(1.+TBI*^^) 

SB=TB/CB 

SBI=TBI/CB1 

CO=COS(DLO) 

Cl=SIN(DLO) 

C2=(TBI-TB«C0)/CB 

G3=(TBI*TB+C0)/CB 

TBAC1/C2 

BA»ATAN<TBA) 

TAA=S0RT(G1 *»2+C2»»2) /G3 
AA=ATAN(TAA) 

C AA= 1 , /SORT ( 1 . +TAA»»2 ) 

QAAsTAA^AA 

MU=(AA-SAA)*(SB+SBI )»»2/{ 1 .4CAA) 

NV=(AA+SAA)*(S8-SBI )*»2/(1.-CAA) 

D IS1=ABS (A»(AA-F»(MU+NV )/4. ) > 

BA10=BA»180./PI 
IF(C2.LE.O.) BA1D=BA1D+180. 

I F(C1 .LE.O. .AND.C2.6E.0. ) BA1D=360.4BAtD 
C 

C SPHERICAL MODEL 
C 


“ 98 “ 


c 

c 

c 


c 

c 

c 


c 


me=(LA2-LAn/2. 

PAB»(LA1+LA2)/2. 

TARTAN (DLO/2. ) 

T1 »ATAN (S I N (MAB )/ (COS (RAB) »TA ) ) 

T2=ATAN (COS (MAB ) / ( S I N (PA8 ) «TA ) ) 

BET*T2-TI 

BA2D=BET»180,/PI 

I F(C2,LE.O. .AND.C1 ,LE,0. ) BA2D=BA2D+360, 
I F(G1 ,LE.0,.AND.C2.GE,0. ) BA2D-360,+BA2D 
LAC»2. WAN (TAN(MAB )»S I N (T2 )/S I N(T1 ) ) 
LAC-LAC*180./PI 
DIS2»60.0*LAC 
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SIMPLIFIED ELLIPTICAL MODEL 


X=DLO*COS(PAB) 

Y»LA2-LAJ 

RR= ( (A «S I N (PAB ) ) **2+ ( B«COS (PAB ) ) *»2 )/B 
0 IS3»RR*S(JRT(X**2+Y«»2) 

BA3=ATAN(X/Y) 

BA3D»BA3»I80./PI 

IF(X.6E.0,.AND.Y,GE.0,> CONTINUE 
I F(X.LE.O. .AND.Y.GE.O. ) BA30=360.+BA20 
IF(Y.LT.0.) BA30=BA30+180. 

ERROR CALCULATIONS FOR THREE MODELS 

ERR1=D ISl-RANGE 
ERR2=D IS2-RANGE 
ERR3=DIS3-RANGE 
ERRB1=BA1D-BEAR 
ERRB2=BA20-BEAR 
ERRB3=BA30-BEAR 

ERROR1 =( (D I SI -RAN6E)/RANGE ) »100. 

ERR0R2=( (0!S2-*RANGE)/RANGE)»t00, 

ERR0R3= ( (D I S3-RANGE)/RANGE ) »100. 

ERRBA1=( (eA1D-B£AR)/BEAR)»100. 

ERRBA2=( (BA2D-BEAR)/BEAR)»!00. 

ERRBA3=( (BA30-BEAR)/BEAR)*100. 

WRlTE(6,200) D!S1,ERR1,BA1D,ERRB1,DIS2,ERR2,BA2D,ERRB2, 

1 DIS3,ERR3,BA3D,ERRB3 

200 FORMATdX, ' DIS1= ',F'; 1.5,5X, ' ERR1=« ,F9,5,5X, » BA1D=»,F7.3, 

1 4X,' ERRB1=',F6.3/ 

2 IH ,* D|S2=',FI1,5,5X, • ERR2= i,F9.5,5X, ' BA2D=»,F7.3, 

3 4X,» ERRB2=',F6,3/ 

4 IH ,» OIS3=',Fn.5,5X, » ERR3=i,F9,5,5X, » BA3D»',F7.3, 

5 4X,‘ ERRB3=',F6.3) 

WR I TE (6 , 300 ) ERROR 1 , ERROR2 , ERR0R3, ERRBA I , ERRBA2, ERRBA3 
300 FORMATdX, » ERR0R1 = ' ,F9.6,5X, ' ERR0R2=»,F9.6,3X, • ERR0P3»»,F9.6/ 
3 IH ERRBA1=',F9.6,5X,' ERRBA2=t ,?9.6,3X, • ERRBA3=',F9.6) 

STOP 
END 

SUBROUTINE RDLL(PHI ,THE) 




C 

C THIS SUBRCWINE CONVERTS GEOCENTRIC COORDINATES ENTERED BY THE 

C USER TO RADIAN COORDINATES. INPUT FORM IS: DODD MM SS.SS 

C WHERE 'DODD' IS THE DEGREES PORTION OF THE LAT. OR LONG., 

C INCLUDING SING, »MM* IS THE MINUTES PORTION, AND 'SS.SS* IS THE 

C SECONDS PORTION. READ FORMAT I : 14, IX, I2,1X,F5.0. 

C 

C 

IMPLICIT REAL«8(A-H,0-Z) 

REAL *4 PH I, THE 

DATA PI /3. 1415926535898/ 

DATA MSG1/'LAT1'/,MSG2/'TUOE'/,MSG3/'; '/,MSG4/'LONG'/,MSG5/ 

1'ITUD»/,MSG6/»E: '/ 

PI1=PI/180, 

C 

C PROMPT USER. 
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WRlTEt6,1) MSG1,MSG2,MSG3 
READ(5,tO) l01,IMt,SSl 

PH I «SNGl (P 1 1 » (DFLOAT (1 D I ) +(DFL0AT( IMl)+SSl /60. )/60. ) ) 

PROMPT USER FOR LONGITUDE ENTRY. 

WITH (6,1) MS64,MS65,MSG6 
RE«)(5,10> ID1,IM1,SS1 

THE«SNGL(PI1*(DFL0AT(IDl)+(0FL0AT(IMl)+SSt/60.)/60,)) 

RETURN 

1 F0RMAT(» ENTER »,3A4/» DODD MM SS.SS») 

15 FQF.MAT(2X,I4,1X,I2,1X,F5.2) 

10 F0RMAT(I4,1X,J2,1X,F5.2) 

3 FORMATC LATITUDE - »,54siX,l2,lX,F5.2/' LONGITUDE » »,U,1X,I2, 

« !X,F5.2) 

END 

SUBROUTINE RA8E(DIST,0EGR) 


THIS SUBROUTINE READS RANDG AND BEARING WHIOl ARE PUBLISHED. 

c 

DATA MSG7/'0|ST»/,MSG8/fANCE»/,MS69/'BEAR»/,MS610/MNG '/ 

C 

WRITE(6,2) MSG7,MSG8 
READ(5,20) OIST 
C 

WRITE(6,4) MSG9,MSG10 
READ (5,40) DEGR 
C 

RETURN 

2 FORMAT(! ENTER ',2A4/» OODD.DDOOD*) 

4 FORMAT(» ENTER »,2A4/' BBB.BBB') 

20 FORMAT (F 10, 5) 

40 FORMAT (F7.3) 

25 FORMAT<2X,F10.5) 

45 FORMAT(2X,F7.3) 

END 


onmimL mes b 
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APPENDIX C» Program listing for -microprocessor version of area 

navigation (BNAV) program. This program Is written in 
standard MDS6502 assembly language and assembled by a 
cross assembler on the IBM4341e 


» * 

THIS PROGRAM PROVIDES NAVIGATIONAL INFORMATION USING THE 
MICROOOFPUTER 6502 AND THE AM9511A MATH CHIP. THERE ARE TWO 
PARTS, THE FIRST PART IS DESIGNED TO CONVERT LORAN-C TIME- 
DIFFERENCES TO LATITUDE/LONGITUDE BY J.P.FI SCHERCTPJVCKING 
FILTER ON TIME DIFFERENCES WERE ADDED LATER BY F.OGURt), AND THE 
SECOND PART IS DESIGNED TO CALCULATE RANGE/BEARING TO A WAY- 
POINT, CROSS TRACK ERROR FR<>1 DESIRED COURSE, GROUND SPEED 
AND ESTIMATFB TIME OF ARRIVAL TO THE WAYPOINT BY F. OGURI. 
BOC-TO-HEX CONVERSIONS ARE M^DE FOR TIME-DIFFERENCES, 

WAYPOINTS AND GRI, AND HEX-TL'-BCO CONVERSIONS ARE MADE FOR 
ALL CALCULATED NAVIGATIONAL INFORMATION; ALL INTEF(NAL 
CALCULATIONS ARE MADE USING BINARY FLOATING-POINT. ALL SUB- 
ROUTINE ARE AT THE END OF THE MAIN PROGRAM. THE NUMBER TABLE 
AREA IS DESIGNED TO BE PLACED AFTER THE SUBROUTINES; 

CONSTANTS ARE FIRST, CALCUUTED VARIABLES LAST, 

FIRST PART; ALGORITHM IS BASED ON FORTRAN PROGRAM 'DEXL!^,' 

FISCHER 


COOOOOlO 

C0000020 


* 

SECOND PART: ALGORITHM IS BASED ON FORTRAN PROGRAM 'DIST3.» 

* 

» 

ELLIPTICAL MODEL, 1/1982, F. OGURI 



CHANGE FOR THE VIDEO BOARD, 10/1982, F, OGURI 

« 





u 

PIAA 

EQU $9000 PERIPHERAL AND DDR SIDE A 


PIAB 

EQU $9002 PERIPHERAL AND DDR SIDE B 


K 

AM9511A COMMANDS. 

1 

FADD 

EQU 

$10 


FSUB 

EQU 

$11 


FMUL 

EQU 

$12 


FDIV 

EQU 

$13 


SORT 

EQU 

1 


SIN 

EQU 

2 


COS 

EQU 

3 


ATAN 

EQU 

7 


PTOF 

EQU 

$17 


PUPI 

EQU 

$1A 


FLTD 

EQU 

$1C 


FIXD 

EQU 

$1E 


CHSF 

EQU 

$15 


TAN 

EQU 

$04 


XCHF 

EQU 

$19 


ASIN 

EQU 

$05 


OMUL 

tt 

EQU 

$2E 


* 

• 


VARIABLE NAME TABLE (FOR TD-TO-POSITION CONVERSION) 


« 


THE FOLLOWING ARE CONSTANTS. 


TOY 

EQU 

0 


TCZ 

EQU 

TCY+4 


THMY 

EQU 

TCZ+4 


TFWT 

EQU 

THMY+4 


XNR 

EQU 

THMZ+4 


CTMY 

EQU 

XNR+4 



C0000150 

COOOOI60 

C0000190 


C0000210 

C0000220 

C0000230 


00000370 

C0000390 

C00004I0 

C0000420 
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smY 

CTMZ 

STM2 

CXK 

SXK 

Cl 

C2 

C3 

C4 

C5 

C6 

C7 

C8 

C9 

CIO 

Cll 

C12 

C14 

EM6 

C256 

PI 80 

C69 

ALP 

BET 

TM 

M 

K 


EOU CTMY+4 
EOU STIY+4 
EQU CTM2+4 
EOU STMZ+4 
EOU CXK+4 
EQU SXK+4 
EOU »1/+4 
EOU C2+4 
EOU C3+4 
EOU C4+4 
EOU C5+4 
EOU C6+4 
EOU C7+4 
EOU C8+4 
EOU C9+4 
EOU CIO+4 
EOU Cl 1+4 
EOU Cl 2+4 
EOU Cl 4+4 
EOU EM6+4 
EOU C256+4 
EOU P 180+4 
EOU C60+4 
EOU ALP+4 
E(jU BET+4 


OF POOR QUAUW 


ALPHA FOR FI LTER ON TDS 

BETA FOR FI LTER ON IDS 

TIME INTERVAL FOR FILTER ON TDS 


THE FOLLOWING ARE CALCULATED VARIABLES, 
<FOR TD-TO-POSITION CONVERSION) 


TY EOU TM+4 

TZ EOU TY+4 

PY EOU TZ+4 

PZ EOU PY+4 

CFY EQU PZ+4 

SPY EOU CPY+4 

CPZ EOU SPY+4 

SPZ EOU CPZ-H 

AY EOU SPZ+4 

AZ EOU AY+4 

BY EOU AZ+4 

BZ EOU BY+4 

Ut EOU BZ+4 


U2 

EOU U1+4 


U3 

EOU U2+4 


UU 

EOU U3+4 


COBY 

EOU UU+4 


TFMS 

EOU CDBY+4 


CB 

EOU THMS+4 


CA 

EOU CB+4 


CC 

EOU CA+4 


F 

EOU CC+4 


G 

EQU F+4 


H 

EQU G+4 


THGS 

EOU H+4 

LONGITUDE OF THE RECEIVER 

PH3S 

EOU THGS+4 

LATITUDE OF THE RECEIVER 

TEMP 

EQU PHGS+4 


TYP 

EOU TEMP+4 


TZP 

EOU TYP+4 


lYS 

EOU TZP+4 


TZS 

EQU lYS+4 


VTYP 

EOU TZS+4 


VTZP 

EOU VTYP+4 


» 

PAGE-ZERO ASSIGNMENTS 
ORG O’ 

TDA 

BSS 4 

PACKED BCD /W TENTH DIGIT 


BSS 4 
ORG $66 

PACKED BCD /W TENTH DIGIT 

AGCF 

BSS ? 


AGCB 

BSS 1 


BASE! 

BSS 2 

BASE ADDRESS FOR NUMBER MOVE 

XLIM 

BSS 1 

INDEX LIMIT USED |N NUMBER CONVERSION ROUTINES 


C0000730 


00000750 


COO0I060 

00001070 

00001080 
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XTEMP 

BSS 

1 

SAVE ftSEA FOR X-REGESTER 



YTEMP 

BSS 

1 

SAVE AREA FOR Y-REGESTER 



COUNT 

BSS 

1 

COUNT-DOWN RE6ESTER 



VY 

BSS 

1 




FLAG 

BSS 

1 




HEX 

BSS 

3 

TABLE FOR BUILDING UP HEX NUMBER FROM BCD 



RES 

BSS 

3 

RESIDUE TABLE FOR BINARY MULTIPLICATION 



DVDN 

BSS 

2 

HEX NUMBER TO BE CONVERTED TO BCD 



CNT2 

BSS 

1 




CWT3 

BSS 

1 




CNT4 

BSS 

1 




CNT5 

BSS 

1 




PREWP 

BSS 

1 

PREVIOUS WAYPOINT NUMBERS 



FLG3 

BSS 

t 




Thf’ 

BSS 

2 

TEMPORARY RF^ISTER FOR 6R'/ CONVERSION 



6RI1 

BSS 

1 

ADDRESS OF GS REFERENCE VABLE(GRI LOOP COUNT) 


ARCN 

BSS 

1 

ADDRESS OF GS REFERENCE TABLE(RANGE) 



CTEKJ 

BSS 

t 

ADDRESS OF GS REFERENCE TABLE(CTEB) 



LOLA 

BSS 

1 




L0P6 

BSS 

1 

FLAG FOR LOWPAGE OF VIQEO SCREEN 



FLT 

BSS 

1 




NOLP 

BSS 

1 




TDTMP 

BSS 

1 




PRTMP 

BSS 

i 




SMTMP 

BSS 

1 




VLTMP 

BSS 

1 









C0001270 



THE FOLLOWING ARE THE 


C0001280 

« 


COMPUTED 

LATITUDE/LONGITUDE AND RANGE/BEARING. ALL 


00001290 

* 


ARE IN PACKED BCD FORMAT, THESE ARE DESIGNED TO 


C0001300 

* 


INTERFACE 

TO SENSOR SOFTWARE. 


C0001310 

« 





00001320 

LAT 

BSS 

3 

FORMAT; (EX.) 39 19 20 - DEGREES, MINUTES, 

SEOON 



BSS 

3 

FORMAT; (EX.) 82 05 56 - DEGREES, MINUTES, 

SECON 



BSS 

3 

FORMAT; (EX.) 01 34 52 - HOURS, MINUTES, SECOND 


GSP 

BSS 

10 

FORMAT: (EX.) 20 56 - 205.6 KM 



BASE 

BSS 

2 

ADDRESS OF FLOATING-POINT TABLE 



VIDEO 

BSS 

2 

ADDRESS OF VIDEO SCREEN K.XP 



WP 

BSS 

1 

MN ; WAYPOINTN M=l,5 N=1,S 



WPG 

BSS 

1 

TO WAYPOINT 



WPS 

BSS 

1 

FROM WAYPOINT 



LLLP 

BSS 

1 




WPTB 

# 

BSS 

48 

NO DD MM SS 00 DO MM SS ; LA2 AND L02 IN DEGREE 


* 

USER'S WAYPOINT TABLE 




ORG 

$AC 





HEX 

12 

-WP 




HEX 

00 

-WPG 




HEX 

00 

-WPS 




* 


* 

* ADDRESS OF GRI AND 81 FI 

« 

GRI EQU $0012 GRI DATA BUFFER 

BIF1 EQU $0041 LOOP COUNTER 

GRIN EQU $03E0 REFERENCE TABLE FOR GRI LOOP COUNT 

* THE FOLLOWING ARE CONSTANTS. (FOR RNAV) 

* 


RCR2 

EQU 0 

3443.91 74NM 

FI 

EQU RCR2+4 

0.00335278 

F2 

EQU Fl+4 

1-F1 

ONE 

EQU F2+4 

1 

FOUR 

EQU ONE+4 

4 

D3618 

EQU FOUR+4 

3600» 180/PI 

036E6 

EQU D3618+4 

36.0E6 

F20 

EQU 036E64-4 

20 

P18 

EQU F20F4 

180/PI 

PAI2 

EQU PI 8+4 

2fPI RADIANS 

PI2D 

EQU PA 12+4 

360 DEGREE 

060 

EQU PI2D+4 

60 
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ALPG 

EQU 

D60f4 

ALPHA FOR FILTER IN GS CALCULATION 

BETG 

EOU 

ALPG+4 

BETA FOR FILTER IN GS CALCUUTION 

LOl 

EQU 

BE7G+4 

LONGITUDE OF FROM WAYPOINT 

LAI 

EQU 

LOl +4 

lATIHjOE OF FROM WAYPOINT 

: 02 

EQU 

LA1+4 

LOI'ISITUDE OF TO WAVPOINT 

LA2 

EQU 

LQ2+4 

LATITUDE OF TO WAYPOINT 

« 

CALCULATFB VARIABLES.<FOR RNAV) 

COR 

EQU 

LA?,+4 


SB 

EQU 

OOBt-, 


CBI 

EQU 

SB+4 


SBI 

EQU 

CBI +4 


col 

EQU 

SBI +4 


C02 

EQU 

001+4 


C03 

EQU 

C02+4 


BA 

EQU 

003+4 


SAA 

EQU 

BA+4 


CAA 

EQU 

SAA+4 


AA 

EQU 

OAA+4 


MU 

EQU 

AA+4 


NV 

EQU 

MU+4 


AROi 

EQU 

NV+4 


ARC? 

EQU 

ARC1+4 


PSI1 

EQU 

ARC2+4 


PS) 2 

EQU 

P3I1+4 


BNYY 

EQU 

PS 12+4 


HELPP 

EQU 

BNYY+4 


TIME 

EQU 

HELPP+4 


CTEB 

EQU 

TIME+4 


GS 

EQU 

OTEB+4 


CTEBl 

EQU 

GS+4 


WW 

ft 

EQU 

CTEB 1+4 


» 

ft 

FOR 

GROUND SPEED CALCUUTION. 

CTEBO 

EQU 

WKH-4 

PRIVIOUS CTEB FOR GS CALCULATION 

ARCO 

EQU 

CTEBO+4 

PRIVIOUS RANGE FOR GS CALCUUTION 

GRin 

EQU 

ARCO+4 

TOTAL GRI LOOP COUNT 

GSPRD 

EQU 

GRITT+4 

GS PREDICTED VALUE 

ACPRD 

EQU 

GSPRD+4 


6SSM 

EQU 

ACPRD+4 





CALCULATED VARIABLES FOR BCD TO FLOATING P05NT FORMATCONVERSION. 


ft 

ORG $038C 



BNY 

BSS 4 

WAYPOINT REGISTER 


HELP 

ft 

BSS 4 

GRI CONVERSION REGISTER 



ORG $0380 



GRIT 

ft 

BSS 4 

TOTAL REFERENCE OF GRI LOOP COUNT 



ORG $3A4 



W 

* 

ft 

BSS 4 

TEMPORARY REGISTER FOR WAYPOINT CONVERSION 


ft 

ORG $1800 



ft 



C0001390 

ft 

CONVERT TDi 

'S FROM BCD TO FLOATING-POINT 

C0001400 

ft 

LOX =0 
LDY =TY 
STY YTEMP 

CONVERT TDA FIRST 

COOOI4IO 


LDA =2 
STA COUNT 

CONVERT TWO TOS 



STA BASE+1 
CLD 

SET DECIMAL MODE OFF 


ft 



COG01480 

ft 

BCO-TO-HEX 

CONVERSION 

C0001490 

ft 



C0001500 

TOHEX 

LDY *6 
LDA =0 

SIX DIGITS 
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STA HEX 
STA HEX+1 
STA HEX+2 
STA FLAG 
JMP LFOUR 

DO LOWER PART FIRST 

UFOUR 

DEC FLAG 



LDA 1DA,X 

GET A BYTE 


LSR A 
LSR A 
LSR A 
LSR A 
JMP T03 

DO THE MAIN CONVERSION 

LFOUR 

INC FLAG 



LDA TDA,X 

GET A BYTE 


AND =$F 

REMOVE UPPER FOUR BITS 

T03 

IhX 

CLC 

FOR ADDITION 


ADC HEX+2 
STA HEX+2 

ADD DIGIT TO PARTIAL SUM 


BCC NOC 

GO 1 F NO CARRY OUT 

NOC 

INC HEX+1 
DEY 

NEXT DIGIT 


BEQ TOO 

IF DONE, LEAVE 


STY XTEMP 

SAVE COUNTER 


* 


* MULTIPLY PARTIAL SUM BY TEN 

« 

LDA =0 

STA RES CLEAR MULT. TABLE 

STA RES+1 
STA RES+2 

LDA =10 DIVISOR 

LDY =8 

T02 ac 

ROL RES+2 
ROL RES+1 
ROL RES 
ASL A 
8CC N0C2 
PHA 
CLC 

LDA RES+2 
ADC HEX+2 
STA RES+2 
LOA RES+1 
ADC HEX+1 
STA RES+1 
LDA RES 
ADC HEX 
STA RES 

PI A 

N0C2 DEY 

BNE T02 
LDY )CTEMP 
LDA RES 
STA HEX 
LDA RES+1 
STA HEX+1 
LDA RES+2 
STA HEX+2 
LDA FLAG 
BNE UFOUR 
JMP LFOUR 

* NOW CHANGE INTEGER PART TO FLOATING-POINT 

* THEN ADD IN THE FRACTIONAL PART. 

■» 

TOO LDY YT£W= 

SIX XTEMP SAVE THE CURRENT DIGIT LXATION 

LDA =0 

STA (BASE),Y CLEAR THE UPPER TWO BYTES 
INI' 

LDA HEX 


OF, POOR QUAUTV 


C0001760 

00001770 

00001780 


00002080 
00002090 
00002100 
000021 10 


MSB OF HEX INTEGER 


STA 
I NY 
LDA 
STA 
I NY 
LDA 
STA 
LDY 
JSR 
LDA 
JSR 
LDY 
JSR 
LDA 
JSR 
LDY 
JSR 
DEC 
BEQ 

TODl LDX 
IN< 
LDY 
STY 
JMP 

* ALPHA 

ADFLT LDA 

BNE 

LDX 

LDA 

ABFLTl STA 
INX 
CPX 
BNE 
LDY 
JSR 
LDY 
JSR 
LDY 
JSR 
LDY 
JSR 
JMP 

* 

ABFLT2 LDA 
STA 
LDA 
STA 
LDA 
STA 
LDA 
STA 

ABFLT3 LDY 
JSR 
LDY 
JSR 
LDA 
JSR 
LDA 
JSR 
LDY 
JSR 
LDA 
JSR 
LDY 
JSR 
LDA 
JSR 
LDY 
JSR 


{BASE),Y PUT IN TABLE FOR 9511 OF POOR QUALITY 

HEX+1 LSB OF HEX INTEGER 

(BASE),Y 

HEX+2 

(BASE),Y 

YTEMP POINT TO TO NUMBER 

PUSH GIVE IT TO 9511 

-FLTO 

CWD CONVERT INTEGER TO FLOATU^-POINT 

»£M6 constant lE-7 

PUSH 

=FMUL CONVERT FROM M I CROSECONDS , . , 

CItJD TO SECONDS 

YTENP GET THE TD LOCATION AGAIN 

POP AND STORE THE TD 

COUNT SEE IF BOTH TDS CONVERTED 

ABFLT IF SO, START TD-TO-POSITION CONVERSION 

XTEMP SET UP FOR NEXT TD 

sTZ ADDRESS OF TOB 

rrEMP STORE IT 

TOHEX REPEAT 

BETA FILTERING 

NOLP 

=1 

ABFLT2 

~0 

»0 

$02F8,X 

=8 

ABFLTl 

=TY 

PUSH 

=TZ 

PUSH 

=TZP 

POP 

.-TYP 

POP 

SUTD 

=$7C 

TOTf^ TY 

=$E8 

PRTMP TYP 

=$FO 

SMTMP TYS 

=$F8 

VLTMP VTYP 

TOTMP 

PUSH 

PRTNP 

PUSH 

=FSUB 

GWD TY-TYP 

=PTOF 

CMNO 

=ALP 

PUSH 

=FMUL 

CMND ALP* (TY-TYP) 

PRTMP 

PUSH 

=FADD 

CMND TYP+ALP*(TY-TYP) 

SM^MP 

POP TY S-TYP+ ALP« (TY-TYP ) 
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of’ pS 


LDY =BET 
JSR PUSH 
LDA -FMUL 
JSR CM^O 
LDY «TM 
JSR PUSH 
LDA =FDIV 
JSR CM^D 
LDY VLTMP 
JSR PUSH 
LDA =FAPD 
JSR CWD 
LDA *PTOF 
JSR CMND 
LDY VLTMP 
JSR POP 
LDY =TM 
JSR PUSH 
LDA =FMUL 
JSR CMND 
LDY SMTMP 
JSR PUSH 
LDA =FADD 
JSR CMND 
LDA =PTOF 
JSR C^tgD 
LDY PRTMP 
JSR POP 
LDY TDTMP 
JSR POP 
LDA TDTMP 
CMP =$80 
BEO SUTD 
A8FLT4 I NC TDTMP 
INC PRTMP 
INC SMTMP 
INC VLTIf* 
LDA TDTMP 
CW= =$80 
BNE ABFLT4 
JMP ABFLT3 


BET»(TY-TYP) 


VTYP=VTYPFBET* {TY-TYP)/TM 

TM*VTYS 

TYS+TM»VTYS 

TYP=TYS+TM«VTYS 

TY=TYS+TM»VTYS 


« CALCULATE 'PY» 


LDY =XHR 

•XNR' 

JSR PUSH 

PUSH ON STACK 

LDY =TY 

•TY» 

JSR PUSH 
LDY =TCY 

•TCY' 

JSR PUSH 
LDA =FSUB 
JSR CMND 

SUBTRACT TY-TYC 

LDA =FMUL 
JSR CWD 

XNR»(TY-TYC) 

LDY =THMY 

»THMY' 

JSR PUSH 
LDA =FSUB 
JSR CMJD 

XNR»(TY-TZ)-THMY 

LDY =PY 

ipyi 

JSR POP 

PUT »PY' INTO TABLE 

CALCULATE 

»PZ» 

LDY =XNR 

*XNR» 

JSR PUSH 

PUSH ONTO STACK 

LDY =TZ 

•TZ» 

JSR PUSH 

PUSH ONTO STACK 

LDY =TCZ 

*TCZ' 

JSR PUSH 

PUSH ONTO STACK 

LDA =F3UB 
JSR CMND 

TZ-TCZ 

LDA =FMUL 
JSR CmD 

XNR»(TZ-TCZ) 


00002770 

C0002780 

C0002790 


00002960 

00002970 

C0002960 
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LDY 

-THMZ 

»THMZ' 

JSR 

PUSH 



=FSl)B 


JSR 

CM4D 

XNR*(TZ-TCZ)-THMZ 

LDY 

H=*2 

LOCATION FOR *PZ» 

JSR 

POP 

STORE RESULT IN «PZ 


CAL,CUUTE CPY,SPY,CPZ^SPZ 

LDY 

=PY 

fPY» 

JSR 

PUSH 

PUSH IT 

LDY 

«PY 

•PY* 

JSR 

PUSH 

DUPLICATE STACK 

LDA 

=00S 


JSR 

CWJD 

OOS(PY) 

LDY 

sCPY 

FOR CPY 

JSR 

POP 

GET IT 

LDA 

=SIN 


JSR 

CWD 

SIN(PY) 

LDY 

»SPY 


JSR 

POP 

GET SPY 

LDY 

=PZ 

•PZ» 

JSR 

PUSH 


LDY 

=PZ 


JSR 

PUSH 


LDA 

=005 


JSR 

CWD 

COS(PZ) 

LDY 

=CPZ 

LOCATION FOR CPZ 

JSR 

POP 


LDA 

=SIN 


JSR 

CMND 

SIN(PZ) 

LDY 

=SPZ 

LOCATION FOR »SPZ‘ 

JSR 

POP 



CACULATE 

•AY' 

LDY 

=CPY 

'CPY' 

JSR 

PUSH 


LDY 

=CrMY 

'CTMY' 

JSR 

PUSH 


LDA 

=FSUB 


JSR 

CWD 

CPY-CTMY 

LDY 

=STMY 

'STMY' 

JSR 

PUSH 


LDA 

=FDIV 


JSR 

CWD 

(CPY-CTW)/STMY 

LDY 

=AY 

•AY» 

JSR 

POP 



CALCULATE 

'AZ' 

LDY 

=CPZ 

'CPZ' 

JSR 

PUSH 


LDY 

=CTMZ 

'CTMZ' 

JSR 

PUSH 


LDA 

=FSUB 


JSR 

CWD 

CPZ-CTMZ 

LDY 

=STMZ 

'STMZ' 

JSR 

PUSH 


LDA 

=FD1V 


JSR 

CWD 

(CPZ-CTMZ )/STMZ 

LDY 

=AZ 

LOCATION FOR »AZ' 

JSR 

POP 


CALCULATE 

»BY» 

LDY 

=SPY 

•SPY' 

JSR 

PUSH 


LDY 

=STMY 

•STMY' 

JSR 

PUSH 


LDA 

=FDIV 


JSR 

CWD 

SPY/STMY 

LDY 

=BY 

LOCATION FOR 'BY' 


ORIGSWAL Ilf 
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C0003150 

00003t60 

00003170 


C0003420 

C0003430 

00003440 


00003570 

C0003580 

00003590 


00003720 

C0003730 

00003740 


* * m * * m 


« 

* 

* 


* 

« 




JSR POP 


ORlGSNAt PArS jG 
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CALCULATE 

'BZ* 

C0003830 

C0003840 

LDY «=SPZ 

• SPZ» 

C0003850 

JSR PUSH 
LDY *STMZ 

•STMZ' 


JSR PUSH 
LDA sFDIV 
JSR CM^D 

SPZ/STMZ 


LDY »BZ 

LOCATION FOR 'BZ' 


JSR POP 

GET IT 


CALCULATE 

'U1 ' 

C0003940 

C0003950 

LDY =AY 

'AY' 

C0003960 

JSR PUSH 
LDY =CXK 

'CXK' 


JSR PUSH 
LM =FMUL 
JSR CMNO 

AY»CXK 


LDY =AZ 

'AZ' 


JSR PUSH 
LDA =FSUB 
JSR CMND 

AY«CXK-AZ 


LDY =U1 

LXATION FOR »U! ' 


JSR POP 

CALCULATE 

'U2' 

C0004090 

C0004100 

LDY =AY 

'AY' 

00004110 

JSR PIBH 
LDY »SXK 

'SXK' 


JSR PUSH 
LDA =FMUL 
JSR CM^D 

AY«SXK 


LDY =U2 
JSR POP 

GET 'U2' 


CALCULATE 

'U3' 

00004200 

C0004210 

LDY =AZ 

'AZ' 

00004220 

JSR PUSH 
LDY =BY 

'BY' 


JSR PUSH 
LDA =FMUL 
JSR CMND 

AZ«BY 


LDY =AY 

'AY' 


JSR PUSH 
LDY =BZ 

'BZ' 


JSR PUSH 
LDA «FMUL 
JSR CMND 

AY«BZ 


LDA =FSUB 
JSR CfS'lD 

AZ«BY-AY«BZ 


LDY =U3 

LOCATION FOR 'U3' 


JSR POP 

CALCULATE 

'UU' 

C0004390 

C0004400 

LDY =U1 

'U1 ' 

C0004410 

JSR PUSH 
LDY =C1 

'U1' 


JSR PUSH 
LDA =FMUL 
JSR CMND 

U1»U1 


LDY =U2 

»U2' 


JSR PUSH 
LDY =U2 
JSR PUSH 



LDA =FMUL 
JSR CMND 

U2«U2 


LDA aFADD 
JSR CmD 

Ul'Hn+U2»U2 
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ORSQiS^AL 

OF POOR QUALSTV 



LDY >OU 
JSR POP 

LOCATION FOR 'UU' 





00004580 


CALCULATE 

•COBY' 

C0004590 


LDY «UU 

'UU» 

00004600 


JSR PUSH 
LDY HJ3 

»U3' 



JSR PUSH 
LDY =U3 

'U3« 



JSR PUSH 
LCA aFMUL 
JSR CWD 
LDA «FSUB 

U3*U3 



JSR CMND 

UU-U3»U3 



LDA =SQRT 
JSR CWD 

S(JRT(UU-U3»U3) 



LDY «U2 
JSR PUSH 
LDA =FMUL 

'U2' 



JSR CMND 

U2»S0RT(UU-U3«U3) 



LDY =U3 

•U3‘ 



JSR PUSH 
LDY «U1 
JSR PUSH 
LDA =FMUL 

'U1 ' 



JSR CM4D 
LDA =FADD 

U3»U1 



JSR CMND 

U3»U1 +U2 *SQRT< UU-U3»U5 ) 



LDY =<JU 
JSR PUSH 
LDA =FDIV 

'UU' 



JSR CfWD 

(U3»U».+U2«SQRT{UU-U5*U3) )/UU 



LDY =COBY 
JSR POP 

LOCATION FOR 'COBY' 





C0004910 


CALCULATE 

'THMS' 

C0004920 

# 

LDY =AY 

»AY» 

00004930 


JSR PUSH 
LDY -BY 

•BY' 



JSR PUSH 
LDY =COBY 
JSR PUSH 
LDA =FADD 

•CDBY» 



JSR CMND 

BY+CDBY 



LDA =FDIV 
JSR CMND 

AY/{BY+COBY) 



LDA =ATAN 
JSR CWD 

ATAN(AY/(BY+CDBY) ) 



LDY -TMWS 
JSR POP 

LOCATION FOR 'THMS' 


# 



C0005080 

# 

CALCULATE 

'CB' 

C0005090 


LDY =THMS 
JSR PUSH 
LDA -COS 

'THMS' 

00005100 


JSR CM4D 

OOS(THMS) 



LDY -CB 
JSR POP 

LOCATION FOR 'CB' 





C0005170 


CALCULATE 

'CA' 

00005180 


LDY -THMS 

'THMS' 

C0005190 


JSR PUSH 
LDY =PY 
JSR PUSH 
LDA =FADD 

'PY' 



JSR CMND 

THMS+PY 



LDA =COS 
JSR CMND 

COS(THMS+PY) 



ORIG!f'!At 


k‘* 





LDY aCA 
JSR POP 

LXATION FOR 'CA' 

OF POOR QUAL5'?V 




00005300 


CALCULATE 

«CC» 

00005310 


LDY =THMS 

•THMS' 

C0005320 


JSR PUSH 
LDY =PZ 
JSR PUSH 
LDA =FADD 

IPZ' 


.t70 

LDA aPADD 
JSR CMND 

TmS+PZ 



LDA =COS 
JSR CWD 

COS(THMSHPZ) 



LDY =CC 
JSR POP 

LOCATION FOR »CC* 


M 



C0005430 


CALCULATE 

•F* 

C0005440 

« 

LDY =C1 
JSR PUSH 

•Cl» 

C0005450 


LDY =CA 
JSR PUSH 
LDA =FMUL 

•CA' 



JSR CWD 

C1»CA 



LDY =C2 

»C2' 



JSR PUSH 
LDY aCB 

•CB' 



JSR PUSH 
LDA aFMUL 
JSR CMND 
LDA =FADD 

C2*CB 



JSR Cf*4D 

C1«CA+CZ«CB 



LDY =C3 

•C3» 



JSR PUSH 
LDY =CC 
JSR PUSH 
LDA =FMUL 

•CC 



JSR CWD 

C3»CC 



LDA =FADD 
JSR CW4D 

C1«CA4C2*CB+C3»CC 



LDY =F 
JSR POP 

LOCATION FOR 'F' 


« 



C0005700 

* 

CALCULATE 

'G» 

00005710 

« 

LDY aC4 

•C4* 

C0005720 


JSR PUSH 
LDY =CA 
JSR PUSH 
LDA =FMUL 

•CA* 



JSR CM^D 

C4«CA 



LDY =C5 

•C5» 



JSR PUSH 
LDY =CB 

•CB> 



JSR PUSH 
LDA =FMUL 
JSR CWO 
LDA =FADD 

C5»CB 



JSR CM^D 

C4»CA+C5»CB 



LDY =C6 

«C6' 



JSR PUSH 
LDY =CC 
JSR PUSH 
LDA =FMUL 

«CC 



JSR CM^D 
LDA =FADD 

C6»CC 



JSR Cf-WD 

C4*CA+C5»CB+C6»CC 



LDY =G 

'G' 



JSR POP 

GET *G' 



OF POOK « “ 


* 



C0005970 

» 

CALCUUTE 

•H' 

00005980 

» 

LDY «C7 
JSR PUSH 

*C7» 

C0005990 


LDY =CA 

»CA' 



JSR PUSH 
LDA =FMUL 
JSR CWD 

C7*CA 



LDY =C8 

•C8' 



JSR PUSH 
LDY =CB 
JSR PUSH 
LDA =FMUL 

•CB' 

a 


JSR CMND 
LDA =FADD 

C8»CB 



JSR CNND 

C7»CA+C8*CB 



LDY =C9 

'C9» 



JSR PUSH 
LDY =€C 

•CC» 



JSR PUSH 
LDA -FMUL 
JSR CMND 

C9»CC 



LDA =FADD 
JSR CWD 

C7»CA+C8^»CB+C9»CC 



LDY =H 
JSR POP 

LOCATION 'H» 


» 



C0006240 

» 

CALCULATE 

•THGS» 

C0006250 

» 

LDY =<5 

•G« 

C0006260 


JSR PUSH 
LDY =CIO 
JSR PUSH 
LDA =FADD 

•C10> 



JSR CWD 

G+CIO 



LDY sF 

•F' 



JSR PUSH 
LOY =C1 1 
JSR PUSH 

»C1 1' 



LDA =FADD 
JSR CWJD 

F+Cll 



LDA =FDIV 
JSR CMND 

(GfC10)/(F+CM> 



LDA =ATAN 
JSR CNWD 
LDA =PTOF 

ATAN((G+C10)/(F+C11)) 



JSR CKWD 
LDY =THGS 

DUPLICATE STACK 



JSR POP 

GET THGS 



LDY =P180 
JSR PUSH 
LDA =FMUL 

180/PI 



JSR CWD 

CONVERT FROM RADIANS TO DEGREES 



LDX =3 

POINT TO LONGITUDE FIELD 



LDA =6 
STA XLIM 

INDEX LIMIT 



LDA =$86 
STA VY 

VIDEO LOCATION FOR LONG. 



JSR T0BCO2 

CONVERT TO DEGREES, MINUTES, SECONDS 



* 



C0006490 



* 

CALCULATE 

•PHGS» 

00006500 




LDY =TH6S 
JSR PUSH 
LDA =SIN 

*THGS» 

C0006510 


1 


JSR CMND 

SIN(THGS) 



1 


LDY =C14 




1 


JSR PUSH 
LDY =C14 
JSR PUSH 
LDA =FMUL 



; 

1 
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r 


OF POOn Ci;;AUT' 



JSR CK^D 
LDA bFWJL 

C14«C14 


JSR CMND 

C14»04*SIN(TH6S) 


LDY »H 
JSR PUSH 



LDY =0 2 
JSR PUSH 
LDA =FADD 

'02' 


JSR CMND 
LDA =fFMUL 

H+C12 


JSR CWD 

C14»04»SIN(THGS)»(H+12) 


LDY =G 
JSR PUSH 

'G' 


LDY =C10 
JSR PUSH 
LDA =FADD 

'CIO' 


JSR CMND 
LDA =FD1V 

G+C13 


JSR CWD 
LDA =ATAN 

Cl 4‘»0 4»S 1 N<THGS) »(H+C1 2)/(GfCI 0) 


JSR CMND 
LDA =PT0F 

ARCTAN <C 1 4*0 1 4 »S 1 N ( THGS ) » ( H+CI 2 ) / (G+C 1 3 ) ) 


JSR CMND 
LDY ^^’HGS 

DUPLICATE STACK LOCATIONS 


JSR FOP 

GET PHGS 


LDY =P180 
JSR PUSH 
LDA =FMUL 

180/PI 


JSR CMND 

CONVERT PHGS FROM RADIANS TO DEGREES 


LDX =0 

LOCATION FOR LATITUDE FIELD 


LDA =3 
STA XLIM 

INDEX LIMIT 


LDA =$66 
STA VY 

VIDEO LXATION FOR UT, 


JSR T0BC02 

CONVERT TO DEGREES, MINUTES, SECONDS 


» AREA NAVIGATION CALCULATION 


RNAV 

LDA 

=3 



STA 

BASE-H 

BASE=$300 

» 

OLD 




LDX 

=1 



SIX 

FLG3 

FLG3=I 


LDA 

WP 



CMP 

PREWP 

IS A WAYPOINT CHANGED? 


BNE 

ViPCV2 

IF YES, GET NEW WAYPOINT COORDINATE. 


DEC 

FLG3 

FLG3=0 

-K 

JMP 

RABAO 


« 

K 

CONVERT WAYP0INT(LO2,LA2) FROM BCD TO FLOATING POINT. 

WPCV1 

LDA 

VP 

READ WAYPOINT NUMBERS 

WPCV2 

STA 

PREWP 

STORE NE“ WAYPOINT NUMBERS 


LDX 

FLG3 

WHEN FLG3=1, FROM WAYPOINT CASE. 


BED 

WPCV3 

WHEN FLG=0, TO WAYPOINT CASE. 


AND 

»$F0 

READ FROM WAYPOINT NUMBER 


LSR 

A 



LSR 

A 



LSR 

A 



LSR 

A 



STA 

WPS 

STORE FROM WAYPOINT NUMBER 


ORA 

=$30 



STA 

$A0I5 

DISPLAY FROM WAYPOINT NO. 


JMP 

WPCV4 


WPCV3 

AND 

***“iCi‘ 

READ TO WAYPOINT NUMBER 


STA 

VPG 

STORE TO WAYPOINT NO. 


ORA 

=$30 



STA 

$A055 

DISPLAY TO WAYPOINT NO. 

WPCV4 

LDX 

=0 



STX 

CNT2 


LO 

LDA 

WPTB,X 



C0006700 


♦ 


* 


OF POOR QUAUTV' 



AND 

«SFO 


LSR 

A 


LSR 

A 


LSR 

A 


LSR 

A 


LDY 

FLG3 


CMP 

WPG,Y 


BEQ 

LOO 


LDY 

i=8 

WPCV5 

INX 



DEY 



BNE 

WPCV5 


JMP 

LO 

LOO 

LDA 

=0 


STA 

CNTl 


STA 

VW-1 


STA 

W+2 


STA 

W+3 


STA 

BNY 

LIO 

LDA 

WPTB,X 


AND 

=1 


BEQ 

L7 


LDA 

=$64 


STA 

W+3 


LDA 

=1 

L7 

LDY 

FLG3 


BEQ 

L2 


LDY 

CNT2 


BNE 

L77 


LDY 

=0 


JMP 

L3 

L77 

LDY 

=$20 


JMP 

L3 

L2 

LDY 

CNT2 


BNE 

L22 


LDY 

=$40 


JMP 

L3 

L22 

LDY 

=$60 

L3 

ORA 

=$30 


STA 

$A017,Y 


INY 


L4 

INX 



LDA 

W=TB,X 


LSR 

A 


LSR 

A 


LSR 

A 


LSR 

A 


ORA 

=$30 


STA 

$A017,Y 


INY 



LDA 

tf^TB,X 


AND 

=$0F 


ORA 

=$30 


STA 

$A017,Y 


INY 



INY 



CPY 

=$0A 


BEQ 

L6 


CPY 

=$2A 


BEQ 

L6 


CPY 

=$4A 


BEQ 

L6 


CPY 

=$6A 


BEQ 

L6 


JMP 

L4 

L6 

DEX 



DEX 



« 


READ WAYPOINT NO. ON WAYPOINT TABLE 


FIND tt^YPOINT NUMBER 
IF FIND NO., BRANCH TO LOO 

INCREMENT 8 TIMES 


TRY TO FIND AGAIN 

aEAR COUNTERl 

CLEAR TEMPORARY REGISTER 


CLEAR MSB OF WAYPOINT REGISTER 


IF DEGREE IS LESS THAN 100, BRANCH TO L7 


» UPDI6IT»I0+L0WDIGIT 
L5 LDA *0 

STA BNY+3 CLEAR LSB OF WAYPOINT REGISTER 
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LDY 

=4 

L« 

LOA 

WPT8,X 


STA 

LOI.A 

L88 

ASL 

BNY+3 


ASL 

LOLA 


BW 

L9 


LOA 

*50 


Ct.C 



ADC 

BNY+3 


STA 

BNY+3 

L9 

DEY 



BNE 

L68 


LDA 

M=>TB,X 


AND 

*$0F 


CLC 



ADC 

BNY+3 


STA 

BNY+3 

L25 

INC 

CNTl 


lf«< 



» VPT. REGISTER 
CLC 

LDA W+3 
ADC BNY+3 
STA BNY+3 
BCC L28 
INC W+2 
L28 LDA W+2 
STA BNY+2 
LDA W+1 
STA BNY+1 
LOY CNTl 
CPY =3 
BNE L35 
JMP L50 

* 


ORfgJKAL 
OF POOR 


QUALITY 


WHEN IT'S DONE, (BNY+3)=UPD1G|T»10. 
READ LOWDIGIT 

(BNY+3)»UPOIGIT»10+LOWDIGIT 
NEXT BYTE 

= TEMP.REGISTER+WPT.REGISTER 


IF IT'S NOT OONE, BRANCH TO L35 
IF THE CONVERT I ON IS DONE, JMP TO L50 


* MULTIPLY BY 60 

N 

L35 STX CNT3 
LDY =’3NYY 
JSR PUSH 
LDY =D60 
JSR PUSH 
LDA =DMUL 
JSR CftlD 
LDY =WW 
JSR POP 
LDX CNT3 
JMP L5 

« 

L50 STX CNT3 
LOY =BNYY 
iSSR PUSH 
LDA =FLTD 
JSR CMND 
LDY =03618 
JSR PUSH 
LDA =FDIV 
JSR CMND 
LDA FLG3 
BEQ L70 
LDA CNT2 
BNE L60 
LDY =LA1 
JSR POP 
INC CNT2 
LDX CNT3 
JMP LOO 

L60 LDY =L01 
JSR POP 
DEC FLG3 
JMP WPCVl 

L70 LDA CNT2 


TEMP, REGISTER = WPT.REGI STER^SO. 

IF THE MULTIPLICATION IS DONE, JUff> TO L5 


CHANGE FIXD TO FLOATING POINT 


DIVIDE BY 3600 AND CONVERT IT INTO RADIAN UNIT 


CONVERSION FOR LATITUDE OF FROM WPT. IS DONE 


CONVERSION FOR LONGITUDE OF FROM VPT. IS DONE 
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OF POOR QUAUTV 



BNE L80 
LOY ■LA2 
JSR POP 

CONVERSION FOR LATITUDE OF TO M>T. IS DONE. 

L60 

INC CNT2 
LDX CNT3 
JMP LOO 
LDY «LQ2 



JSR POP 

CONVERSION FOR LONGITUDE OF TO WPT. IS DONE. 

It 

INC FLG3 

FLG3-1 

It 

tt 

TRANSFER CONTENTS 

OF THGS, PHGS TO LOI, LA5 IN THIS PROGRAM 


LOY »LA1 

WHEN WAYPOINT ARE NOT CHANGED. 


JSR PUSH 

DESIRED COURSE IS CALCUUTEO. 

It 

JMP TRAN1 


It 

n 

CALCUUTE 'COB* 

AND 'SB* 

RABAO 

DEC 0ASE+1 

BASE-$200 


LDY *PHGS 

PHGS IS UTITUDE OF THE RECEIVER. 


JSR PUSH 
INC BASE+1 

3ASE-$300 

IRANI 

LDA -TAN 



JSR CWD 

TAN (LAI ) 


LDY -F2 
JSR PUSH 
LDA =FMUL 
JSR CWD 

F2»TAN(LA1) 


LDA -ATAN 
JSR CWD 

8-ATAN(F2»TAN(UD) 


LDA -PTOF 
JSR CMND 
LEA. ^GOS 
JSR CMND 

COS(B) 


LDY -COB 
JSR POP 

OOB=COS(B) 


LDA -SIN 
JSR CMIO 

SINCBT 

M 

LDY -SB 
JSR POP 

SB-SIN(B) 

It 

n 

CALCUUTE >CBI' 

AND 'SBI ' 


LDY -LA2 
JSR PUSH 
LDA -TAN 
JSR CMND 

TAN(LA2) 


LDY -F2 
JSR PUSH 
LDA -FMUL 
JSR CMND 

F2«TAN(LA2) 


LDA -ATAN 
JSR CItID 

BI-ATAN(F2*TAN(LA2)) 


LDA -PTOF 
JSR CMND 
LDA -SiN 
JSR CMND 

SIN(BI) 


LDY -SBI 
JSR POP 

SBI-SIN<B|) 


LDA -COS 
JSR C^tlD 

COS(BI) 

# 

LDY -CBI 
JSR POP 

CBI -COS (Bl ) 

It 

it 

CALCUUTE 'C01» 



LDA FLG3 
BEQ RABA1 

IF WAYPOINTS ARE NOT CHANGED. BRANCH TO RABA 


LDY =L01 

WHEN WAYPOINTS ARE CHANGED. 


JSR PUSH 

DESIRED COURSE IS CALCUUTED. 

RABA1 

JMP RABA2 
DEC BASE+1 
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^ 4: 


am 


» i( 1* >'-■-. L. 


RABA2 


» 


LDY »THGS 


JSR PUSH 


IN3 BASE+1 


LDY »L02 


JSR PUSH 


LDA «FSUB 


JSR CWD 

L01-L02 

LDA =PTOF 


JSR CWD 


LOA =SIN 


JSR CMND 

S!N(DL0) 

LDY -CBI 


JSR PUSH 


LOA »FMUL 


JSR CM^D 

C0S(BI)«SIN(DL0) 

LDY »C01 


JSR POP 

001=COS(BI)»SIN(DLO) 


OF POOR QUALITY 


» 


« 


CALCULATE 'C02' 


LDA =00 S 
JSR CMND 
LDY «CBI 
JSR PUSH 
LDA “FHJL 
JSR CW^O 
LDA *PTOF 
JSR CM4D 
LDY *S8 
JSR PUSH 
LDA =FMUL 
JSR C^t4D 
LDY =COB 
JSR PUSH 
LDY »SBI 
JSR PUSH 
LDA =rpiUL 
JSR CWO 
LDA =XCHF 
JSR CKjND 
LDA =FSUB 
JSR CM^ 
LDY =C02 
JSR POP 


OOS(DLO) 

COS(BI )"COS(DLO) 

SIN(B)«C0S(8I )«COS(DLO) 

COS(B)«SIN(BI ) 

COS(B)«SIN(BI )-SIN(B)«COS<Bt )*COS(DLO) 
C2=OOS(B)»SIN(BI )-S|N(8)»C0S(BI )*COS(DLO) 


» CALCULATE «C03» 


LDY =COB 
JSR PUSH 
LDA =FMUL 
JSR CWD 
LDY =SB 
JSR PUSH 
LDY =SBI 
JSR PUSH 
LDA =FMUL 
JSR CWD 
LDA =FADD 
JSR CK{D 
LDY »C03 
JSR POP 

CALCUUTE »BA* 

LDY =C01 
JSR PUSH 
LDY «C02 
JSR PUSH 
LDA -FDIV 
JSR CM4D 
LDA -ATAN 
JSR CMND 


COS(8)»COS(BI )«COS(DLO) 


SIN(B)»S!N(BI ) 

SIN{B)»SIN(BI )+COS(B)*COS(BI )*COS<DLO) 
C03=SiN(B)»SIN(BI )4C0S(B)«00S(BI )«COS(DLO) 


C01/C02 

ATAN(C01/C02) 




Ifc m 


oRSGSi^fiL r/ • ^ ^ ; 

OF POOR 


LDA =PTOF 
JSR CM40 


LDY =8A 
JSR PCP 

BA=ATAN(C01/C02) 

CALCULATE »AA' 


LDA »PT0F 
JSR CMND 
LDA »COS 
JSR CMKD 
LDY =C02 

COS (BA) 

JSR PUSH 
LDA =FMUL 
JSR CMND 
LDA -XCHF 

CO2»00S(BA) 

JSR CMND 
LDA *SIN 
JSR CMND 

SIN(BA) 

LDY =001 
JSR PUSH 
LDA =FMUL 
JSR CWD 
LDA =FADD 

C01«SIN(BA) 

JSR CMND 
LDY »C03 
JSR PUSH 
LDA =FDIV 

C02*C0S(BA)+C01»SIN(BA) 

JSR CMND 
LDA =ATAN 

(C02*C0S(BA)+C01 »S{N(BA) )/C03 

JSR CNND 
LDA =PTOF 

ATAN( (C02*C0S(BA)+C01 «SIN(BA) ),A003) 

JSR CMND 
LDY =AA 
JSR POP 

AA=ATAN( (G02»C0S(BA)+C01 »SI N(BA) )/C03) 

CALCULATE 'SAA' 

AND 'CAA' 

LDA =f’TOF 
JSR ChtlD 
LDA =SIN 
JSR CMND 

SIN(AA) 

LDY =SAA, 
JSR POP 
LDA =COS 

SAA=SIN(AA) 

JSR C^tJD 
LDY =CAA 

COS(AA) 

JSR POP 

CAA=C0S(AA) 

CALCULATE »MU* 


LDY =SB 
JSR PUSH 
LDY *S81 
JSR P»JSH 
LDA =FADD 
JSR CMND 
LDA =PTOF 
JSR CMND 
LDA =FMUL 

SIN(B)+S!N(BI ) 

JSR CMND 

M=(SIN(B)+SIN(BI ))»»2 


LDY =ONE 
JSR PUSH 
LOY =CM 
JSR PUSH 
LW =FSUB 
JSR CMvlD 
LDY =SM 
JSR PUSH 
LDA =FDIV 


l.-COS(AA) 
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JSR C^t^D 
IDY =M 
JSR PUSH 
LDY »SAA 
JSR PUSH 
LDA fpSUB 
JSR CMND 
LDY aSM 
JSR PUSH 
LDA =FDIV 
JSR CMND 
LDA =FMUL 
JSR CWD 
LDA =FMUL 
JSR CWD 
LDY »«J 
JSR POP 


n.-COS(AA))/SlN(AA) 


CIlSOi; 

OF POOR QUAUl’V 


AA-SIN(AA) 

(AA~SIN(AA))/SIN(AA) 

U=(1.-COS(AA))/SiN(AA) * (AA-SIN(AA) )/SI N{AA) 
M»U 

MUaM*U 


CALCULATE «NV> 


LDY =SB 
JSR PUSH 
LDY =SBI 
JSR PUSH 
LDA =FSUB 
JSR CMND 
LDY =SAA 
JSR PUSH 
LDA =roiv 
JSR CfjWD 
LDA =PTOF 
JSR Cf«D 
LDA =FMUL 
JSR CWD 


S|N(B)-SIN(BI } 


(SIN(B)-SIN(BI ))/SIN<AA) 


Na( (SIN(B)-SIN(BI ))/SIN(AA) )*»»2 


LDY ONE 
JSR PUSH 
LDY OAA 
JSR PUSH 
LDA =FADD 
JSR cmo 
LDY =AA 
JSR PUSH 
LDY =SAA 
JSR PUSH 
LDA =FAOD 
JSR CWD 
LDA =FMUL 
JSR CMND 
LDA =FMUL 
JSR CMND 
LDY =NV 
JSR POP 


1.4COS(AA) 


AA+SIN(AA) 

V=( 1 .+COS(AA) )*(AA+SI N(AA) ) 


N»V 

NV=<N«V 


CALCULATE 'RANGE* 


LDY =AA 
JSR PUSH 
LDY =MU 
JSR PUSH 
LDY =NV 
JSR PUSH 
LDA ="FADD 
JSR CMND 
LDY =F1 
JSR PUSH 
LDA aFMUL 
JSR CMND 
LDY aPOUR 
JSR PUSH 
LDA aFDIV 
JSR CMMD 


MU+NV 

F1»(MU4NV) 


Fl«<MU+NV)/4 


n 




LOA *FSUB 
JSR CWD 
LDY *RCR2 
JSR PUSH 
LDA =FMJL 
JSR OWD 
> ^Y =ARC1 
JSR POP 


ORIGINAL 

OF POOR QUALI7Y 

AA - Fl«(MU+NV)/4. 


RCR2*( AA - F1»(MU+NV)/4. ) 
ARC t =RCR2* ( AA-F 1 « (MU +NV ) /4 , ) 


LDY =AROl 
LDA (BASE),Y 
BPL L44 
JSR PUSH 
LDA *CHSF 
JSR CMND 
LDY >*ARC1 
JSR POP 


IF ARCl IS NEGATIVE, CHANGE THE SIGN TO POSITIVE 


ARC1=-ARC1 


» CALCULATE 'BEARING* 


L44 LDY =BA 
JSR PUSH 
LDY =C02 
LDA (BASE),Y 
BPL L55 
LDA =PUP1 
JSR CM^D 
LOA =FADD 
JSR Cf-ND 
JMP L66 
L55 LDY =C01 

LDA (BASE),Y 
BPL L66 
LDY *PAI2 
JSR PUSH 
LDA =FADD 
JSR CN^'ID 
L66 LDA =PTOF 
JSR CMND 
LDY =PSI1 
JSR POP 
LDY =P18 
JSR PUSH 
LDA =FMUL 
JSR CMND 

# 

* VIDEO DISPLAY FOR ARCl (RANGE) AND PSIl (BEARING) 


DEC VIOEO+1 
DEC 8ASE+1 

BASE=$200 

LDX =2 

LOCATION FOR BEARING 

LDA =$D7 
STA VY 
JSR RNG8 

VIDEO LOCATION FOR BEARING 

INC BASE+1 
LDY =ARC1 

BASE=$300 

JSR PUSH 
DEC BASE+1 

8ASE=$200 

LDX =0 

LOCATION FOR RANGE 

LDA =$B7 
STA VY 
JSR RNGB 

VIDEO LOCATION FOR RANGE 

INC VIDEO+1 
INS BASE+1 

BASE=$300 

CALCULATE GRI 


LDA FLG3 

IS A WAYPOINT CHANGED? 

BB? N55 
LDX =0 

IF FLAG3=0, GO TO N55 


IF C02>0, JUMP TO L55 
BA+180 

IF C01>0, JUMP TO L66 
BA+360 
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STX TMP 

(TMP)»0 




STX TMP+1 
STX HELP 

(TMP+1 )=0 
(HELP)=0 

OF POOR 

QUALITY 


STX HELPfl 
LDY =0 

(HELP+1 )=0 



N1 

LDA GRI.X 

A=(GRI+X) 




CPY =0 
BEQ N2 

IF FLG2=0, GO TO N2 




AND =$F0 
LSR A 
LSR A 
LSR A 

UPPER BYTE 




LSR A 
DEY 
JMP N3 

JUMP TO N3 



N2 

AND =$0F 

LOWER BYTE 




INX 

X^^X+l 




INY 




N3 

CLC 

CLEAR CARRY 




ADC TMP+1 

A+( TMP+1 ) 




STA TMP+1 

(TMP+1 )=(TMP+1 )+A 




BCC N4 

IF CARRY=0, GO TO N4 




INC TMP 

(TMP)=1 



N4 

CPX =2 
BEQ N5 

IF X=2, GO TO N5 




ASL TMP+1 

(TMP+1 )»2 




ROL TMP 

(TMP) *2 




LDA TMP+1 
STA HELP+3 
LDA TMP 

( HELP+3 )=( TMP+1) 




STA HELP+2 

(HELP+2)=(TMP) 




ASL TMP+1 

(TMP+1 )»2 




ROL TMP 

(TMP)*2 




ASL TM’+l 

(TM=+1)*2 




ROL TW> 

(TMP)»2 




CLC 

LDA TMP+1 
ADC HELP+3 

CLEAR CARRY 




STA TMP+1 

(TMP+1 )=(TMP+1 )+(HELP+3) 



LDA TMP 
ADC HELP+2 
STA TMP 

(TMP)=(TMP)+(HELP+2) 




JMP N1 

JUMP BACK TO N1 



N5 

LDA TMP 
STA HELP+2 
LDA TMP+1 
STA HELP+3 
JMP 3LNK1 

JUMP TO BLNK1 





CALCULATE CROSS 

TRACK ERROR IN DEGREE AND DISTANCE. 

N55 

LDY =PSI2 



JSR PUSH 
LDY =PSI1 
JSR PUSH 
LDA =FSUB 
JSR crtiD 

PSI2-PSI1 


LDA =PTOF 
JSR CMND 
LDY =CTE8 
JSR POP 

CTEB=PSI2-PSI1 


LDA =1 
STA FLT 

FLT=1 


LDY =CTEB 
LDA (BASE),Y 
BPL Z10 

IF CTEB IS POSITIVE, BRANCH TO Z10 


LDA =0 
STA aT 

IF CTEB IS NEGATIVE, FLT=0 


LDA =CHSF 

IF CTEB IS NEGATIVE, CTEB=-CTEe 


JSR CMIO 



■ *B«»EKisgss; 
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ZIO LDA =fUPI 
JSR CWO 
LDA =FSUB 
JSR CM40 
LDA =PTOF 
JSR CFND 
LDY =CTEB1 
JSR POP 
LDA (BASE),Y 
BMI Z40 

« 

Z20 LDA =PUPI 
JSR CWD 
LDA =FSU8 
JSR CWO 
LDA =CHSF 
JSR CWD 
LDA =PTOF 
JSR CWD 
LDY =CTEB 
JSR POP 

« 

Z30 LDA FLT 
BEQ Z40 
LDY =P18 
JSR PUSH 
LDA sFMUL 
JSR CWD 
LDA =SOC 
STA $A116 
LDA =0 
STA CNT2 
JMP Z50 

* 

Z40 LDA FLT 
BEQ Z30 
LDA =PTOF 
JSR CWD 
LDA K3HSF 
JSR 

LDY =CTE8 
JSR POP 
LDY =P18 
JSR PUSH 
LDA =-FM)L 
JSR CWD 
LDA =$12 
STA $A1 16 
LDA =1 
STA CNT2 

» 

Z50 DEC BASE+1 
LDX =6 
LDA =$37 
STA VY 
JSR RNGB 
INC BASE+1 
LDY =CTEB 
JSR PUSH 
LDA =SIN 
JSR cmo 
LDY =ARC1 
JSR PUSH 
LDY =RCR2 
JSR PUSH 
LDA =FDIV 
JSR CMND 
LDA =SIN 
JSR CM4D 
LDA =FMUL 
JSR CM4D 
LDA =ASIN 


OF POOR QUALITY 


CTEB-PI 


IF CTEB .LT. PI, BRANCH TO Z40 

CTEB-PI 

CTEB=-CTEB 


IF CTEB IS NEGATIVE, GO TO Z40 

CONVERT TO DEGREE 

INDICATE »L» ON CRT SCREEN 
WHEN CNT2=0,'LEFT' INDICATION 

IF CTEB IS NEGATIVE, GO TO Z30 


CONVERT TO DEGREE 
INDICATE 'R> ON CRT SCREEN 
WHEN CNT2=1, 'RIGHT' INDICATION 
BASE=$200 

LXATION FOR CROSS TRACK ERROR BEARING 
VIDEO LOCATION FOR CTEB 

BASE=$300 

SilN(CTEB) 


ARC1/RCR2 

SIN{ARC1/RCR2) 

SIN(CTEB)»SIN(ARC1/RCR2) 


ORIGIF^AL PASE IS 

OF POOR QUALITY 



JSR CWD ASIN(SIN<CTeB)*SIN(ARC1>^CR2) ) 

LDY =RCR2 
JSR PUSH 
LDA sFMUL 

JSR CWD RCR2»ASIN{SIN(CTEB)«S(N(ARC1/RCR2)) 

LDA »PTOF 
JSR CWD 
LDY =SB 
JSR POP 
LDY =SB 
LDA (BASE),Y 
BPL CTE3 
JSR PUSH 
LW =CHSF 
JSR ChMD 

CTE3 DEC BASE+1 BASE=$200 

DEC FLAG 

LDX =8 LOCATION FOR CROSS TRACK ERROR 

LDA =$17 VIDEO LOCATION FOR GTE. 

STA VY 
JSR RNGB 

IfC BASE+1 BASE=$300 

» 

» COl DISPLAY 

K 

LDX =$C0 
LDA =00 

CD 10 STA $A100,X ERASE PREVIOUS CD I NEEDLE INDICATION 
INX 

CPX =$E0 
BCC CD to 
LDA =3 

STA SAIGF INDICATE CENTER POINT OF COl 

LDA =01 

STA CNT1 C0l=0.1 

LDX =$CF 
LDY CNT2 

BNE COI4 IF CNT2=1, COl INDICATION ON RIGHT SIDE. 

LDA =$6A 
LDY GSP+8 

8EQ con IF CTE *LT. 10.0 W, BRANCH TO COM 

CD 100 LDX =$C4 INDICATE CD 1=2.1 NM LEFT, WHEN COl .GE. 10.0 NM. 

LDA =$55 
JMP COI8 

con LDY GSP+9 
CPY =$21 

BCS CD 100 IF CTE ,GT. 2.1 NM, BRANCH BACK TO CO 100 

CPY CNT1 

BCC CDI8 IF CTE .LT. CNT1 , BRANCH TO GDIS 

INC CNT1 
LDY CNT1 
CPY =$0A 

BNE C0I2 IF COl .LT. $0A, BRANCH TO COI2 

LDY =$10 

STY CNT1 CNT1=1.0 

CDI2 CPY =$1A 

BNE COI3 IF CDI .LT. $1A, BRANCH TO 0DI3 

LDY =$20 

STY CNT1 CNT1=2.0 

CO 13 EOR =$3F 

CW’ =$55 
BNE con 

DEX DECREASE POSITION REGISTER 

CPX =$C5 
BCS con 
JMP CO 18 
CO I 4 LDA =$55 
LDY GSP+8 

BEO COI5 IF CTE .LT. 10.0, BRANCH TO COI5 

C0I44 LDX =$OA INDICATE CDI=2.1 NM RIGHT, WHEN COl .6E. 10.0 NM 

LDA =$6A 
JMP CO 18 



V, 


ORIGINAI PAGE IS 
OF POOR QUALITY 


C0I5 

LDY GSP+9 
CPY =$21 



BCS CD 144 

IF GTE .GE. 2.1 NM, BRANCH TO CO 


CPY CNTl 

. 


8CC C0I8 
IM3 CNTl 
* LDY CNTl 
CPY =$0A 

IF GTE .LT.CNTl, BRANCH TO CO IB 


BNE CO 16 

IF CNTl ,LT. $0A, BRANCH TO CO 16 


LDY =$10 
STY CNTl 

CNT1=1.0 

C0I6 

CPY =$IA 



BNE CD 17 

IF CNTl ,LT. $1A, BRANCH TO CO 17 


LDY =$20 
STY CNTl 

CNTl *2.0 

CDI7 

EOR =$3F 
Gif’ =$6A 
BNE GDIS 



m 

CPX =$0A 
BCC GDIS 

INCREASE POSITION REGISTER 

C0I8 

« 

STA $A100,X 

INDICATE COI ON CRT SCREEN 


* DISPLAY GROUND SPEED AFTER 56 LOOPS 

LDA NOLP 
=$70 
BEQ AV 1 
INC NOLP 
INC NOLP 
JMP B0TM3 



CALCULATE GROUND 

SPEED 

AVI 

LDA CNT4 



CMP =4 

COLLECT 4 REFERENCES? 


BEQ AV6 
LDY =ARC1 
JSR PUSH 
LDY =CTEB 
JSR PUSH 
LDY CTEBN 
JSR POP 
LDY ARCN 
JSR POP 

IF YES, BRANCH TO AV6 


LDK CNT4 

X=CNT4 


LDA GRI 1 

READ GRI LOOP COUNT 


STA GRIN,X 

(GRIN+X)=GRI1 


CLC 

CLEAR CARRY 


ADC GRIT+3 

(GRIT+3)+A 


BCC AV4 

IF CARRY=0, GO TO AV4 


INC GRIT+2 

(GRIT+2)=1 

AV4 

STA GRIT+3 

(GRIT+3) =(GRIT+3)+(GRIN+X) 

tt 

JMP B0TM2 


AV6 

LDA ARCN 



CMP =$00 

ADDORESS POINTER REACH TO $D0 


BNE AV7 
LDA =$C0 

IF ARCN=$00, NO BRANCH 


STA ARCN 
LDA =$00 

ARCN=$CO 


STA CTEBN 
LDA =0 

CTEBN* $00 


STA CNT5 

CNT5=0 

AV7 

LDY -ARC1 
JSR PUSH 
LDY ARCN 



JSR PUSH 
LDY =ARCO 

PUSH ARCN 


JSR POP 
LDY ARCN 

ARCO=ARCN 
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4 




JSR PCP 


ARCN=ARC1 


OF PoOti QU/IUTY 


LOX CNT5 
LDA 6RIT+3 
SEC 

SBC GRIN,X 
BCS AV8 
DEC GRIT+2 
AV8 CLC 

ADC GRIl 
BCC AV9 
INC GRIT+2 
AV9 STA GRIT+3 
UDA 6RI I 
SfA GRIN.X 

* 


X=CNT5 

CLEAR CARRY 
(GRlT+3)-<GRIN+X) 

IF CARRY=0, GO TO AV8 

(GRIT+2)=0 

CLEAR CARRY 

IF CARRY=0, GO TO AV9 
<GRIT+2)»1 

(GR |T+3)=»(GRIT+3)-(GRI N+X)+(GRM ) 


LDY CTEB 
JSR PUSH 
LDY CTEBN 

JSR PUSH PUSH CTEBN 

LDY =CT£BO 

JSR POP CTEBO=CTEBN 

LDY CTEBN 

JSR POP CTEBN=CTEB 

» CALCUUTE TIME=GRI»(NO.OF GRI) 

CALTM LDY =HELPP 
JSR PUSH 
LDY =<3R I IT 

JSR PUSH READ TOTAL GRI LOOP COUNT 

LDA =DMUL 

JSR CNND GRI»GRITT 

LDA =FLTD 

JSR CM^D 

LDY =036E6 

JSR PUSH 


LDA =FDIV 

JSR CMND CONVERT IN HOUR 

LDY =TIME 
JSR POP 


•• CALCULATE AVERAGE GROUND SPEED 


GS1 LDY =ARCO 
JSR PUSH 
LDY =ARC1 
JSR PUSH 
LDA =FSUB 
JSR CWD 
LDA =PTOF 
JSR CWD 
LDA =FMUL 
JSR CMND 
LDY =CTEBO 
JSR PUSH 
LDY =CTEB 
JSR PUSH 
LDA =FSUB 
JSR CM4D 
LDY =ARC1 
JSR PUSH 
LDA =FMUL 
JSR CSWD 
LDA =PTOF 
JSR CWD 
LDA =FMUL 
JSR CWD 
LDA =FADD 
JSR CI«ID 
LDA =SQRT 
JSR cmD 
LDY *TIME 
JSR PUSH 


ARCO-ARCI 

(ARCO-ARCI 

CTEBO-CTEB 

ARC1»DCTF.B 

(ARC1«DCTE8)»»2 

(ARCO-ARCI )*»2+(ARC1»DCTEB)*»2 
SQRT( (ARCO-ARCI ) »»2+(ARCI»DCTEB)«»2) 
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II 


ORlGfs^'AL m 
OF POOR QUALITY 


LOA «FDIV 

JSR CWD S<?RT((ARC0-ARCl)»'»2+{ARC1»0CTEB)»»2)/TIME 


LOA =PT0F 
JSR CWD 
LDY «F20 
JSR PUSH 
LOA *FSUB 
JSR CI440 
LOY =ODl 
JSR POP 
LDY »C01 
LDA (BASE),Y 
BPL GS2 
LDY =«SPRD 
JSR PUSH 
LCft --«CHSF 
JSR C^•4D 
JMP ABGS 

GS2 LDY =«SPRD 
JSR PU'' ' 

LDA ^'<-auf 
JSR CJ4ID 

« 


IF GS ,GE. 0.0, BRANCH TO GS2 


-GSPRD 


GS08S-GSPRD 


» ALPHA BETA FI LTER FOR GS 

« 

ABGS LOA «PTOF 
JSR CMND 
LDY *ALPG 
JSR PUSH 
LDA =FMUL 

JSR CMND ALPG»(6S0GS-GSPRD) 

LOY =6SPRD 
JSR PUSH 
LOA *FADD 

JSR CMND GSPRD+ALPG»(GSOBS-GSPRD) 

LDY >GSSM 

JSR POP GSSM*GSPRD+ALPG»(GSOBS-GSPRD) 


LDY =BETG 
JSR PUSH 
LDA =FMUL 
JSR ChtID 
LDY =TIME 
JSR PUSH 
LDY =FOUR 
JSR PUSH 
LM =FDIV 
JSR CMND 
LDA =FDIV 
JSR CMND 
LDY =ACPRD 
JSR PUSH 
LDA =FADO 
JSR CWD 
LDA *f>TOF 
JSR CMND 
LDY *ACPRD 
JSR POP 

LDY *TIME 
JSR PUSH 
LDY *FOUR 
JSR PUSH 
LDA *FDIV 
JSR CWD 
LDA =FMUL 
JSR CW4D 
LDY =«SSM 
JSR PUSH 
LDA =FADD 


BETG«(GSOBS-GSPRO) 


BETG* (GSOBS-GSPRD ) /T I ME 


ACPRD+BETG* (GSOBS-GSPRD )/T I IJE 


TIME»ACSM 
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n 

JSR CWD 

GSSM+TIME»ACSM 

GS3 

LDA aPTOF 
JSR CMND 
LDY "KSS 



JSR POP 
LDA *f*TOF 
JSR CfMD 
LDY =GSPRD 

GS=GSPRD+GAI N» (GSOBS-GSFRD ) 


JSR POP 
LDY =GS 
LDA (BASE),Y 

GSPRD=GS 


BPL GS5 
LDA aCHSF 

IF GS IS NEGATIVE, 


JSR CWD 

GS=-GS 

6S4 

LDA :fTOF 
JSR CMND 
LDY =GS 
JSR POP 


GS5 

DEC BASE+1 
LDA «1 
STA LOPG 

BASE=$200 


LDX =4 

LXATION FOR GROUND SPEED. 


LDA =$78 
STA VY 

VIDEO LOCATION FOR GS. 


JSR RNGB 

DISPLAY GS ON CRT SCREEN 

» 

INC BASE+1 


» 

» CALCULATE ESTIMATE 

« 

TIME OF ARRIVAL 

ETOAOO LDA GSP+4 



BNE ET0A2 
LDA GSP+5 
BNE ETOA2 
LDX =0 
LDA =$20 


ETOAO 

LDY BLANK3,X 
STA $A100,Y 
INX 

CPX =6 
BCC ETOAO 
JMP BOTM 

BLANK DISPLAY FOR ETA, WHEN 

ETOA2 

LDY =ARC1 
JSR PUSH 
LDY =GS 
JSR PUSH 
LDA =FDIV 



JSR CMND 
DEC 8ASE+1 
DEC FLAG 

ETA=ARC1/GS 


LDX =6 

LOCATION FW ESTIMATE TIME ( 


LDA =9 
STA XLIM 

INDEX LIMIT 


LDA =$98 
STA VY 

VIDEO LXATION FOR ETA. 


JSR T0BCD2 
INC BASE+1 
JMP B0T14 

DISPLAY ETA ON CRT SCREEN. 

80TM2 

INC CNT4 

CNT4=CNT4+1 

BOTM 

INC CNT5 
LDY =4 

CNT5=CNT5+1 

AV10 

INC ARCN 

ARCN=ARCN+4 


INC CTEBN 
DEY 

CTE8N=CTEBN+4 


BNE AV10 

IF Y-0, NO BRANCH 

BOTM3 

SED 

SET DECIMAL MODE FOR SENSOR 


RTS 

RETURN TO MAIN PROGRAM 

BLNK1 

LDX =0 


BLNK2 

LDA =$20 

BLANK DISPLAY FOR GS. , ETA 


LDY BLANK l,X 

WHEN WAYPOINT IS CHANGED. 




nc r. - • IS 

POOR QUALrry 
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STA $A100,Y 

CPX =18 
BCC BLNK2 
LDY 1 
JSR PUSH 
LDY =PS12 
JSR POP 
LDY =ARC1 
JSR PUSH 
LDY =ARC2 
JSR POP 
LDA =«0 
STA C3NT5 
STA CNT4 
STA LOPG 
STA Nap 
LDY a$BO 

REF STA $0300 ,Y 
I NY 

CPY =$BC 
BNE REF 
LDA =$00 
STA ARON 
LDA =$00 
STA CTEBN 
SED 
RTS 


STORE THE DESIRED COURSE BEARING 


STORE THE DESIRED COURSE RANGE 


ARCN=$CO 

CTEBN=$00 

SET DECIMAL MODE FOR SENSOR 
RETURN TO THE MAIN PROGRAM. 


ORIGINAL Pmt IS 
OF POOR QUALITY 




» * C0007970 
» THIS SUBROUTINE INITIALIZES THE PIA FOR USE WITH » C0007980 
* THE MATH CHIP AND THEN SETS THE CONTROL INPUTS OF THE * C0007990 
» MATH CHIP TO INACTIVE STATES. » C0008000 
« * C0008010 


* 00008030 


PINT 


LDA 

PIAA 

CLEAR INTERRUPTS 

LDA 

PIAB 



LDA 

=$14 



STA 

PIAA+1 

SET 

INTERRUPT CONTROL AND DDR 

LDA 

=0 



STA 

PIAB+1 

SET 

DDR LOW 

LDA 

=$CF 



STA 

PIAB 

SET 

INPUTS AND OUTPUTS FOR 951 1 

LDA 

=4 



STA 

PIAB+1 

SET 

DDR BIT HIGH 

LDA 

=7 



STA 

AGCB 

SET 

BACKGROUND COORDINATION BYTE 

STA 

PIAB 

SET 

CO, RD AND WR HIGH 

LDA 

=$F 



STA 

PIAB 

SET 

SVACK HIGH 

LDA 

PIAA 

CLEAR ANY INTERRUPTS 

LDA 

=0 

GET 

LSB OF NUMBER TABLE 

STA 

BASE 

SAVE FOR INDEXING 

LDA 

=2 

GET 

MSB 

STA 

BASE+1 



LDA 

“$A 



STA 

DVSR 

STORE 10 FOR BINARY DIVISION 

LDA 

=0 



STA 

VIDEO 



LDA 

=$A1 



STA 

VIDEO+1 




K 

» MOVE NUMBER TABLE TO READ/WRITE SPACE 


00008250 

00008260 

C0008270 


LDY =0 CLEAR INDEX ONE 

LOX =0 CLEAR IfOEX TWO 

i,OA TABLE 

STA BASE1 

LDA TABLE+1 

STA DASE1+1 


MVE1 

LDA (BASED, Y 

GET A DIGIT 

ORIGIWAL 

OF 

quauty 


STA $200, X 
im 

STORE IT IN NEW LOCATION 


INY 

CPY =»124 

MOVE 120 YET? 



§ 

BCO MVEl 

IF NOT, CONTINUE 




LOY =0 
LDX =0 
LDA TA8LE2 
STA BASEl 
LQft TABLE2+1 
STA BASED 1 




MVE2 

LDA (BASED,Y 
STA $300,X 





INK 

INY 

CPY =56 





BCX; MVE2 





LOY =0 
LDX =0 
LDA TABLE3 
STA BASEl 
LDA TABLE3+1 
STA BASE1+1 




MVE3 

LDA (BASED, Y 
STA $B0,X 





INX 

INY 

CPY =16 
BCC MVE3 




« 




00008400 

* 

INITIALIZE 

VIDEO DISPLAY OUTPUT 


C00084IO 

« 

LDX =0 



00008420 

WRSCN 

LDY sac,x 

LDA LSCRN,X 
AND =$3F 
STA $AOOO,Y 
INX 

CPX =27 
BCC l«SCN 
LDX =0 




WRSN2 

LDY SCLC2,X 
LDA LSCN2,X 
AND =$3F 
STA $AtOO,Y 
INX 

CPX =36 
BCC VRSN2 




« 

RTS 



C0003510 

« 




C0008530 

* 




00008540 






» 00008560 


SUBROUTINE ' 

rO SEND DATA TO 9511. 


* 00008570 

* 

ITEM NUMBER 

IS IN REG-Y. BASE ADDRESS 


* 00008580 


IS IN 'BASE 



* C0008590 





* C0008600 






00008620 

PUSH 

JSR SAG 

SET P!AA TO OUTPUTS 




INY 

ADJUST REG-Y SO IT 




INY 

POINTS TO LSB OF NUMBER 




INY 

LDX =4 

LOAD COUNT OF 4 > 



PSH1 

LDA (SASE),Y 

GET A BYTE OF THE NW^IBER 




STA PI A A 
LDA =$A 

GIVE IT TO 9511 




JSR SV10 
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LDA PIAA 

CLEAR AMY INTERRUPTS 

OEY 

NEXT BYTE 

DEX 


BNE PSHl 

LOOP UNTIL ENTIRE WOW) WRIHEN 

RTS 

IF DONE, RETURN 


n 

« 

» « 

* SUBROUTINE SETS UP PIA SIDE A AS OUTPUTS. * 

t» » 

» 

SAO UDA PIAAH GET THE CONTROL REGESTER 

SET ACCESS THE DDR 
RETURN IT 


UDA PIAAH 
AND »$FB 
STA PIAA+I 
LDA *$FF 
STA PIAA 
LDA PIAA+1 
ORA =4 
STA PIAA+1 
RTS 


C0008790 

00008800 

C0008810 

C0008820 

C0008830 

C0008840 

C0008830 

00000860 


SET ALL TO OUTPUTS 

SET DDR BIT HIGH 
RETURN IT 


« 

» THIS SUBROUTINE POPS A NUMBER OFF OF THE » 

* 9511 STACK. NUMBEP< IS RETL«NED TO LXATION » 

* WITH 'BASE' AS BASE ADDRESS; ITEM NUMBER IN Y. * 

» * 

'« 

POP JSR SAI SET PIA AS INPUTS 

LOAD COUNT OF 4 


C0000960 

C0008970 

C0008980 

C0008990 

C0009000 

C0009010 

00009020 

C0009030 

00CO9040 


P0P1 


JSR SAI 
LOX =4 
LDA =9 
JSR SV9 
STA (BASE),Y 
LDA =$B 
STA AGCB 
ORA AGCF 
STA PIAB 
INY 
DEX 

BNE POPl 
RTS 


STORE IN TABLE 


SET RD HIGH TO INCR. STACK POINTER 


00 4 BYTES 


« 

« 

* » 

* SUBROUTINE SETS UP PIAA AS INPUTS. » 

« « 

« 


C0009190 

C0009200 

C0009210 

C0009220 

C0009230 

C0009240 

C0009250 

00009260 


SAI 


LDA PIAA+1 
AND a$FB 
STA PIAA+1 
LDA =0 
STA PIAA 
LDA PIAA+1 
ORA =4 
STA PIAA+1 
RTS 


SET ODR BIT LOW 

SET SIDE A TO ALL INPUTS 
SET ODR BIT HIGH 


« 

« 

« « 

* SUBROUTINE SENDS THE COMMAND BYTE IN ACCOM. * 

» TO THE 9511 FOR EXECUTION. ROUTINE RETURNS TO * 

* CALLER REGARDLESS OF WHETHER EXECUTION IS COMPLETED » 

» OR NOT. * 

* 


00009360 

C0009370 

C0009380 

C0009390 

C0009400 

G0009410 

C0009420 

C0009430 

00009440 

C0009450 

00009460 
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CMND 

PHA 

JSR SAO 

SET PI A SIDE A AS OUTPUTS 

ORIGSm 
OF POOR 

QUALIIY 


PU 

GET the command 


STA PIAA 
LDA =>$E 
JSR SV 10 

SEND TO 951 1 




BIT PIAA+t 

TEST IF COMMAND DONE 




BPL *-3 

KEEP TESTING UNTIL DON.^ 




LDA PIAA 

CLEAR THE INTERRUPT BIT 



M 




C0009580 

• 

READ THE 

STATUS RE6ESTER; RETURN IF INVALID CODE 


C0009590 

f 

WAS PRODUCED. 


C0009600 

« 

JSR SAI 

SET PIAA SIDE A AS INPUTS 


00009610 


LDA “SO 

SET C/D HIGH, RD LOW 




JSR SV9 
PHA 

SAVE IT 




LDA »$F 
STA A3CB 
ORA A3CF 
STA PIAB 
PLA 

RETURN 9511 TO INACTIVE STATE 




ANO “SlOOlIilO ZERO OUT UNWORTANT BITS 




BEQ OK 

IF ZERO, CONTINUE PRXESSIN6 




PU 

POP the STACK 




PU 





SED 

SET DECIMAL FOR SENSOR ROUTINE 



OK 

RTS 

RETURN 






» 

SV9 STA AGCB 
ORA A3CF 
STA PIAB 
BIT PIAAH 
BVC «-3 
LDA PIAA 
RTS 

» 

» 


SVIO PHA 

STA AGCB 
ORA AGCF 
STA PIAB 
PLA 
CLC 
ACC *1 
STA AGCB 
ORA AGCF 
STA PIAB 
RTS 


* C0009780 

* C0009790 

C0009800 

« » C0009810 

« THIS ROUTINE CONVERTS THE BINARY FLOATING'-POINT LATITUDE * C0009820 

» ANO LONGITUDE SEPARATELY INTO THE STANDARD DEGREE, MINUTES, * C0009830 

» AND SECOND FORMAT. THE RESULT IS STORED IN BCD. * C0009840 

» » C0009850 

C0009860 

00009870 


INTG ao 

LDA =PTOF 
JSR CSWD 
LDA =FIXO 
JSR CMND 
LDA =PT0F 
JSR CNWD 
LDY *temp 


SET DECIMAL MODE OFF 

DUPLICATE STACK LOCATIONS 

CONVERT POSITION TO AN INTEGER 

DUPLICATE IT 
WORK AREA 


STX XTENP 
JSR POP 
DEY 

LDA (BASE),Y GET THE HEX RESULT 
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AND PLACE FOR HEX-TO-BCO CONVERSION 


STA DVDN+1 






ORlsmAL 
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DEY 




lO^ (8ASE),Y 
STA DVDN 



» 



COO 10040 

* 

ROUTINE TO CONVERT A TWO-BYTE HEX NUMBER TO A FIVE-BYTE BCO 

C0010050 

« 

NUMBER. 


COO 10060 

» 

LDX =4 

COUNT OF FOUR 

00010070 

» 



COO 10090 


DIVIDE BY 

TEN 

C0010100 

X 

UNSPD 

LDA =0 
STA RWDR 

CLEAR REMAINDER 

C00101I0 


LDY =17 
JMP DOI 

SET UP COUNT 


D02 

LDA RMNDR 
SEC 

SET CARRY FOR SUBTRACT 



SBC DVSR 
6PL NREST 

GO IF NO RESTORE 


DOI 

CLC 

JMP MERGQ 

GO TO SET g 


NREST 

STA RWDR 

NEW RESIDUE 



SEC 

g=i 


MERCg 

ROL DVDN+1 
ROL DVDN 
DEY 

DECREMENT COUNT 



BEg RTN 
ROL RWDR 

SHIFT LEFT 



JMP D02 

CONTINUE 


X 



00010300 

RTN 

LDA RNWDR 

GET REMAINDER 



STA DRES.X 
DEX 

STORE IT 



BPL UNSPD 

DO UNTIL DONE 


« 

LDX XTEMP 
RTS 


00010350 

» 



C00103b0 

X 



COO 10390 

T0BC02 

X 

JSR INTG 

GET THE INTEGER PART 

C0OI0410 

X 

STORE TKE 

POSITION COORDINATES ON VIDEO SCREEN 

COO 10420 

X 

LDY VY 

GET VIDEO LXATION 

00010430 


LDA DRES+3 

LOAD MSB 



ORA =$30 

CHANGE TO ASCI 1 



STA (VIDEO),Y 
INY 

LDA DRES+4 
ORA =$30 
STA (VIDEO) ,Y 

GET LS8 


T0B22 

INY 

INY 

STY VY 



« 

LDA DRES+3 
ASl A 

MOVE LOWER FOUR BITS TO UPPER FOUR BITS 

C0010550 


ASL A 
ASL A 
ASL A 




STA LAT,X 

STORE THE DIGIT IN POSITION FIELD 



LDA DRES+4 

GET NEXT DIGIT 

** 


ORA UT,X 

MERGE WITH UPPER DIGIT 



STA UT,X 

REPLACE 

■ 

T0B33 

INX 

CPX XLIM 

SEE IF DONE 



BEQ 0UT2 

RETURN IF DONE 



LDA =FLTD 
JSR CMND 
LDA =FSUB 

CHANGE INTEGER TO FLOATING-POINT 



JSR CMND 

SUBTRACT OFF INTEGER PART 
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LOT =C60 
STX XT01P 
JSR PUSH 
LDX XTEMP 
LOA 

JSR CMNO 
JMP T0BC02 
0UT2 RTS 


MULTIPLY RESIDUE BY 60 




» ROUTINE CONVERTS RANGE AND BEARI.'G FROM BINARY TO BCD * 
« AND STORES THEM, » 
* * 


RNGB JSR INTG GET THE INTEGER PART 

* 


* VIDEO OUTPUT 

« 



LDY VY 
LOA DRES+2 
ORA =$30 
STA (V1DE0),Y 
INY 

LOA LOPG 
BEQ RTNOO 

IF THE DISPLAY NOT FOR GS, BRANCH TO RTNOO 


LOA DRES+2 
BNE RTNOO 
LOA r <:s+3 
QVP 

8CS RTNOO 

IF GS .LE. 30 NM, BRANCH TO RTNOO 

RTNOO 

LOA =0 
STA ORES+3 
STA ORES+4 
LOA DRES+3 


RTNO 

ORA =$30 
STA (VlDEO),Y 
INY 

LOA DRES+4 


RTN1 

ORA =$30 
STA (VIDEO),Y 
INY 



INY 

STY VY 



LOA DRES+2 

3RD ORDER DIGIT 


ASL A 

MOVE LOWER DIGIT TO UPPER 


ASL A 
ASL A 
ASL A 
STA GSP,X 

PUT IT IN RESULT 


LDA DRES+3 

2ND ORDER DIGIT 


ORA GSP,X 

MERGE WITH LAST DIGIT 


STA GSP,X 
INX 

LDA DRES+4 

FIRST DIGIT 


ASL A 
ASL A 
ASL A 
ASL A 
STA GSP,X 

STORE IT 


LSR LCPG 
BCS RTN2 
LDA =FLTO 
JSR CMNO 

CHANGE TO FLOATING-POINT 


LDA =FSUB 



JSR CM4D 

SUBTRACT OFF INTEGER 


LDY =C256 

"256" 


STX XTEMP 
JSR PUSH 



C0010810 
C0010820 
C0010830 
COO 10840 
COO 10850 
COO 10860 
C0010870 
C0010880 

C0010900 
C0010910 
COO 10920 


COO 1 1080 
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LDA =FMUL 


JSR CMNO 
LDA aPIXD 
JSR CMND 

GET FRACTION AS INTEGER 

LDY =TEMP 
JSR POP 
DEY 

WORK AREA 

LDA (BASE),Y 

GET THE FRACTION 

LSR A 

SEARCH-TABLE METHOD OF 

LSR A 

OBTAINING CORRESPONDING 

LSR A 
LSR A 

DECIMAL VALUE 

TAX 

USE AS INDEX 

LDA FRTBLl, X 
LDX XTEMP 
LDY VY 
o;'A =$30 
STA (VIDEO),Y 
AND «$F 

GET THE DECIMAL EQUIVALENT 

ORA GSP,X 
STA GSP,X 
RTS 

STORE THE FRACTION 


cool 1540 
cool 1550 


» » COOl 1570 

* CONSTANT TABLE OF NUMBERS USED IN CALCULATIONS. * COOH580 

» “COOl 1590 

COOl 1600 

* COOl 1610 


TABLE ADR (CNTS) 
CNTS EQU » 


HEX 

7C,9F,BE,77 

00 

- 

TCY 

HEX 

7C,DD,2F,1B 

04 

- 

TCZ 

HEX 7E,9A,EC,71 

08 

- 

THMY 

HEX 7E,98,0F,39 

OC 

- 

THMZ 

HEX 

06,BB,F2,6E 

10 

- 

XNR 

HEX 

00,FD, 13,63 

14 

- 

CTMY 

HEX 

7E,9A,55, 50 

18 

- 

STMY 

HEX 

OO.FD,2E,C3 

1C 

- 

CTMZ 

HEX 

7E, 97, 80,51 

20 

- 

STMZ 

HEX 

7F,BF,D3,EB 

24 

- 

CXK 

HEX 

00,ED,5A,69 

28 

- 

SXK 

HEX 

02,BE,EC,OD 

2C 

- 

Cl 

HEX 

03,89, F5, 17 

30 

- 

C2 

HEX 

83,E5,7E,A9 

34 


C3 

HEX 03,82,DE,4C 

38 

- 

C4 

HEX 

83,8E,0C,13 

3C 

-!■ 

C5 

HEX 

01,93,27,AA 

40 

- 

C6 

HEX 

83,A1 ,A2,81 

44 

- 

C7 

HEX 

03,A3,CA,CE 

48 

- 

C8 

HEX 

00,8F,28,B3 

4C 

- 

C9 


HEX 77, CF, CO, 08 50 - CIO 

HEX 75,87,75,21 54 - Cl 1 

HEX F8,C2,1E,A6 58 - 012 

HEX 01, 80, 6F, 75 5G - C14 

HEX 69,D6,BF,95 60 - lE-7 

HEX 09,80,00,00 6G - C256 ("256'0 

HEX 06,E5,2E,E1 70 - P180 (180/PI) 

HEX 06, FO, 00, 00 74 - C60 (60) 

HEX 7E,AB, 58,08 -ALP 
HEX 79,E5,5D,67 -BET 
HEX 01,B2,7B,B3 -TM 

» END OF NUMBER TABLE; START SCRATCH SPACE 

* 

FRTBLl HEX 00,01,01,02,03,03,04,04 
HEX 05,06,06,07,08,08,09,09 

LSCRN ASC 'FROMWP#TOWP#RANG.NMBRNG.DEG' 

SCLC HEX OD,OE,OF,10,12,13,14 
HEX 4E,4F,52,53,54 
HEX B1 ,32,B5,B4,BA,BD,BE 


COOl 1920 
COOl 1930 
COOl 1940 
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HEX 

01 ,D2,D3,D4,DA,DD,DE,DF 

LSCN2 

ASC 

•CTE.NMCTEB.OEG' 


ASC 

'GSNM/HETA: :COI21012NM' 


HEX 

03 

SCLC2 

HEX 

11,12, 15, 1A,10,1E 


HEX 

31,32,33,34,3A,30,3E,3F 


HEX 

71,72,7C,7D,7E,7F 


HEX 

91, 92,93, 9A, 90 


HEX 

EO,EI ,E2,E5,EA,EF,F4,F9,FE,FF 


HEX 

CF 

BLANK 

HEX 

B7,B8,B9,BB 


HEX 

07,08,09,08 


HEX 

66,67, 69, 6A,6C,6D 


HEX 

86,87, 89,8A,8C,0D 

BLANK 1 

HEX 

16,17,18,19,18 


HEX 

37,38,39,36 

BLANK2 

: HEX 

78,79,7A 

BLANKS 

HEX 

98,99, 9B,9C,9E,9F 


» CONSTANT TABLE OF NUMBERS USED IN CALCULATIONS 

« 

TABLE2 KM (CST) 

CST Egu » 

HEX OC,D7,3E,AE -RCR2 
HEX 78,DB,BA,50 -FI 
HEX 00,FF,24,46 -F2 
HEX 01,80,00,00 -ONE 
HEX 03,80,00,00 -FOUR 
HEX 12,C9,6£,34 -D3618 
HEX lA ,89, 54,40 -D36E6 
HEX 05,AO,00,00 -F20 
HEX 06,E5,2E,E1 -P18 
HEX 03,C9,0F,DA -PA I 2 
HEX 09,84,00,00 -PI2D 
HEX 00,00,00,30 -060 
HEX 7D,A8,58,08 -ALP6 
HEX 77,E5, 50,92 -BETG 
TABLES ADR (CST3) 

CST3 EQU * 

HEX 10,39,16,20 -WPUBIASED UNI NOB) 

HEX 00,82,07,50 

HEX 20,39,13,44 -l#>T2(BI ASEO THRSH - O.U. A IMPORT) 
HEX 00,82,13,55 

* 

END 
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APPENDIX D. Program Listing for Testing Flight Test Data. 

This program converts time differences to coordinates oE position 
and calculates area navigation information (range, bearing, nonfiltered 
ground speed and filtered ground speed) . It is written in standard 
Fortran IV programming language and run in the IBM4341 . 


C THIS PROGRW CONVERT TDS TO COORDINATES OF POSITION. 

C AFTER THE CONVERSION, AREA NAVIGATIONAL INFORMATIONS ARE COMPUTED. 
C (RANGE, BEARING AND GROUND SPEED) 

C 

C MAROI/1985 FUJIKO 06WI 

c 

DIMENSION TH (2 ) ,P0S ( 2 ) , I POS ( 2 ) ,R ANGE (1000), BEAR (1000) 

DIMENSION VLS(2),VLP(2) 

INTEGER EVENT 
PI =3. 141 59265 
J=1 

TaO. 996^*1. 4 
VLP(1 )=0. 

VLP(2)=0. 

TF=12. 

ALP=0,72»T/TF 

BET=ALP»^»2/4. 

TIME=T/3600. 

10 READ (1,i00,END = 300) TH,EVENT,GSD 
100 FORMAT (F9.2,1X,F9.2,1X,I2,34X,F5.1 ) 

C 

C CONVERT TIME DIFFERENCES TO COORDINATES OF POSITION 
C 

CALL DEXLRN(TH,POS) 

DO 20 1=1,2 

IPOS(I) = IFIX(POSd)) * 10000 
TMP = (POS(I) - 1FIX(P0S(I ))) » 60. 

IPOS(I) = IPOS(I) + (IFIX(TMP) * 100) 

TNP = (TW» - IFIX(TMP)) * 60. 

20 IPOS(I) = IPOS(I) + IFIX(TMP) 

C 

IF(J.EQ.IOOI) GO TO 300 
C 

C RANGE AND BEARING ANGLE CALCULATION 
C 

CALL RABE(POS, RANGE, BEAR, J ) 

IF(J.ECJ) GO TO 9 
C 

NONFILTERED GROUND SPEED CALCULATION 
C 

DRANGE=RANGE(J )-RANGE(J”1 ) 

DBEAR=(BEAR(J)-BEAR(J-1))*P 1/180. 

IF(DBEAR.GE,4.46804) DBEAR=2 ,*PI -DBEAR 
I F (DBEAR . LE ,-4.46804 ) D6E AR=2 , »P I +DBEAR 
GS0=SQRT (DRANGE ** 2 + ( RANGE ( J ) *DBEAR ) »^^ ) /T I ME 
IF(J.NEc2) GO TO 199 
GSP=GS0 
ACP=0.0 
GO TO 9 
C 

C FILTERED GROUND SPEED CALCUUTION, INTERVAL=1 CYCLE 
C 

199 GSS=6SP+ALP»(GSO-GSP) 

ACS=ACP+BET» (GSO-GSP ) /T I ME 

GSF=GSS+TIME»ACS 

GSP=GSF 

ACP=ACS 

GSF=ABS(6SF) 
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IF(J,LE.4) GO TO 9 
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FILTERED GROUND SPEED CALCULATION, INTERVAL=4 CYCLES 


DRAN6E=^ANGE ( J )-RANGE ( J-4 ) 
DBEAR=(BEAR(J)-BEAR(J-4))»PI/180. 

I F(DBEAR.GE ,4.46804) DBEAR=2,*PI-0BEAR 
|F(OBEAR,LE,-4.46804) 0eEAR»2.«PN0BEAR 
G S40=S<JRT (ORANGE* *2+ ( RANGE ( J ) *0BEAR ) ««2 ) / (T I ME »4 . ) 
IF(J,E0.5> GS4P=GS40 
IF(J.EQ.5) AC4P=0.0 
GS4S=GS4P+ALP»(6S40-€S4P) 

AC4S-AC4P+BET* (GS40-GS4P)/T I ME 

GS4-GS4S+AC4S*TIME 

GS4P=GS4 

IF(J.LE. 16) GO TO 9 


FILTERED GROUND SPEED CALCULATION, !NTERVAL=16 CYCLES 

DRANGE=RANGE ( J )-(^ANGE ( J- 16 ) 

0BEAR=»(BEAR(J)-BEAR(J-I6))*PI/180. 

IF(OBEAR.GE.4.46804) DBEAR»2.*PI-DBEAR 
I F (D6EAR .LE.-4 ,46804 ) DBEAR«2 , «P I 40BEAR 
GSAO^SORT (ORANGE »*2+ (RANGE (J ) »OBEAR ) »«2 ) / (T I ME » 1 6 . ) 

IF(J.EQ.17) GSAP=GSAO 
IF(J.EQ.17) ACAP=0,0 
GS AS=GSAP+ALP* (GSAO-GSAP ) 

ACAS =ACAP+BET* (GSA0-GS4P ) /T I ME 

GSA=«SAS+ACAS»TIME 

GSAP-GSA 

WR I TE (2, 200 ) TH, EVENT, I POS, RANGE ( J ) ,BEAR ( J ) ,GSD,GS0,6SF,GSA,GS4 
200 FORMAT (F9.2, 1X,F9.2, IX, 12, IX, 16, 1X,I6,8X,F5.) , IX,F5.1 , IX,5F8. 1 ) 
9 J=J+1 
GO TO 10 
300 STOP 
END 

THIS SUBROUTINE CONVERTS TIME DIFFERENCES TO COORDINATES OF 
POSITION. 


SUBROUTINE DEXLRN(TH,POS) 

DIMENSION TH(2),P0S(2) 

DATA TCY,TCZ/3.9E-2,5.4E-2/ 

DATA THMY/0, 1 5l 29258/,THMZ/0. 14849557/,XNR/46. 986746/ 

DATA CTMY/0.98857709/,STMY/0.15071607/,CTMZ/0. 98899478/ 
DATA STMZ/0.14795043/,CXK/0.37466368/,SXK/0. 92716079/ 

DATA Cl/2.9832071/,C2/4.3111683/,C3/-7. 17171 16/ 

DATA C4/4.0896360/,C5/-4.4643647/,C6/1. 1496479/ 

DATA C7/-5.0510869/,C8/5, 1 185063/,C9/0. 55921480/ 

DATA ClO/1 ,5850077E-3/,C1 1/2. 583647 3E-4/,C12/-2. 96203 18E-3/ 
DATA C13/1 ,5850077E-3/,C14/1 ,0034014/ 

DATA PI /3. 141592/ 

TY=TH(1)*l,E-6 

TZ=TH(2)»1,E“6 

PY=XNR»(TY-TCY )-THMY 
PZ=XNR»(TZ-TCZ)-THMZ 
CPY=COS(PY) 

SPY=SIN(PY) 

CPZ=COS(PZ) 

SPZ=SIN(PZ) 

AY=(CPY-CTMY)/STMY 

AZ=(CPZ-CTMZ)/STMZ 

BY=SPY/STMY 

BZ=SPZ/STMZ 

U1=AY*CXK-AZ 

U2=AY*3XX 

U5-=AZ^BY-AV*dZ 

UU=U1*U1+U2*U2 

CDBY=(U3»U1+U2*SQRT (UU-U3»U3 ) )/UU 
TI«S=ATAN (AY/(BY+C0BY ) ) 
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CB»00S{THMS) 

CA»COS<THMS+PY) 

CC=COS(THMS+PZ) 


C 


C 
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F=CI»CA+C2*CB+C3*CC 

G=C4*CA4C5»CB+C6»CC 

H=C7*CA+C8*CB4C9*CC 

thgs=atan ( (G+C1 0) /<F4C ro ) 

PH3S«ATAN(C14*qi4»SIN(THGS)»(H+C12)/(G+C13)) 

P0S(2)=THGS*180./PI 

P0S(O=PHGS»!80./P) 

RETURN 

END 


THIS SUBROUTINE CALCULATES RANGE TO THE VJAYPOINT AND BEARING 
TO TRUE NORTH. 


SUBROUTINE RABE(POS, RANGE, BEAR.J) 

DIMENS I ON POS (2 ) ,RANGE( 1000 ) ,BEAR (1000) 

REAL LA1,L01,LA2,L02,M,N 

DATA P I /3. 14 1 5926 535898/ , A/3443. 9 1 74/ 

LA2=0. 68467327 
L02=l. 43521818 

LA1=P0S(1)<T'I/180. 

L01=POS(2)*PI/180. 

FF=1. - 1./298.2 
F«1 ./298.2 
DL0=LOl-LO2 
TB=FF»TAN(LA1 ) 

TBI=FF*TAN(LA2) 

B=ATAN(TB) 

BI=ATAN(TBI ) 

Cl=COS(BI )*S1N(DL0) 

C2=COS(B)»SlN(Bi )-SlN(B)*COS(BI )^^OS(OLO) 
C3=StN(B)*SIN(BI )+COS(B)*COS(0l )*COS(OLO) 
BA=ATAN (C1/C2) 

TH=ATAN ( (C2»COS{BA)+C1 »SI N(BA) )/C3 ) 
M=C”5IN(B)+SIN(Bt ))»*2 
N=((SIN(B)-SIN(BI ))/SIN(TH))»*2 
U=((l.-COS(TH))/SIN(TH))»*2 
V= ( 1 . -HDOS (TH ) ) » (TH+S 1 N (TH ) ) 

R ANGE ( J ) =ABS (A * (TH-F * (M»U+N « V ) / 4 . ) ) 

BEAR(J)=BA*«180./PI 

IF(C2.LE.O.) BEAR(J)=BEAR(J)+180. 

IF(C1.LE.0..AND.C2.GE.0.) BEAR(J)=360.-+6EAR(J) 

RETURN 

END 
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This program filters time differences (TDs), converts flLtered 
TDs to coordinates of position and calculates area navigation infor- 
mation (range, bearing, CTE/CTEB, nonflltered ground speed, filtered 
ground speed and estimated time of arrival). It Is written in Standard 
Fortran IV programming language and run in the ISH4341. 


C *»»»«»»»»»»*»»»«*(<» K » It I* » rt »»#)»»»»*)* »»» 4 *)(*»* a IK )(**»» » 

C THIS PROGRAM CONVERT TDS TO COORDINATES OF POSITION. 

C ALPHA-BETA FILTER IS USED TO SMOOTH TD DATA. 

C AFTER THE CONVERSION, AREA NAVIGATIONAL INFORMATIONS ARE COMPUTED. 
C (RANGE,BEARING,CROSS TRACK ERROR/BEARING, GROUND SPEED AND 
C ESTIMATED TIME OF ARRIVAL) 

C 

C MARCH/1983 FUJIKO OGURI 

c 

D IMENS ION TH( 2 ) ,POS (2 ) , I POS ( 2 ) .RANGE ( 1 000 ) .BEAR ( 1 000 ) 

DIMENSION TDS(2),TDP{2),TOO(2),VLS(2),VLP(2),PPOS(2) 

INTEGER EVENT, SIDE 

PI-3,14159265 

R-3443.9174 

C ANGLE IS A DESIRED COURSE BEARING TO TRUE NORTH 
ANGLE-241.19 
J»1 

T-0.996»1.4 

TF«6. 

ALPMiW).72»T/TF 
BETA-ALPHA »«2/4. 

VLP(l)-0, 

VLP(2)»0. 

TF-12. 

ALP-0. 72»T/TF 
B£T-ALP»«2/4. 

TIME-T/3600. 

C 

READ{1,100,ENO-300) TDP.EVENT.GSD 
C 

10 READ (1,100, END - 300) TDO,EVENT,GSO 
100 FORMAT (F9.2,1X,F9,2,1X,12,34X,F5.1 ) 

C FILTER TIME DIFFERENCE 
DO 15 1=1,2 

TOS( I )-TDP( I )+ALPHA»(TD0 ( I )-TDP ( I ) ) 

VLS ( I )-VLP ( I )+BETA» (TDO ( I )-TDP ( I ) )/T 

TDP(I)»TDS(I)+VLS(1)*T 

VLP{1)=VLS(|) 

15 TH(I)«TDP{I) 

C CONVERT TIME DIFFERENCES TO COORDINATES OF POSITION 
CALL DEXLRN(TH,POS) 

DO 20 1=1,2 

IPOS(I) = IFIX(P0S(D) * 10000 
TMP = (POS(I) - IFIX(P0S(l ))) « 60. 

IPOS(I) = IPOSd) + (IFIX(TMP) » 100) 

T>f> » (TMP - IFIX(TMP)) » 60. 

20 IPOSd) = IPOSd) + IFIX(TMP) 

IF(J,EQ, 1001) GO TO 300 
CALL RABE(POS, RANGE, BEAR, J ) 

IF(J.E0.1 > GO TO 9 
C 

DL0NG-PP0S(2)-P0S(2) 

OUT«POS(l)-PPOSd) 

PLAT-(POS ( 1 )-»f POS (1 ) )«P 1 /360 . 
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X=DL0N6«C0S(PLAT) 

Y»DLAT 

DREOATAN (X/Y ) » 1 80 . /P I 
I F(X.LE.O , .AND.Y ,GE ,0. ) DRECTs560 .+0RECT 
IF(Y.LT,0.) DRECT=ORECT+iaO. 

Z=ANGLE-ORECT 
IF(2.GE.270.) Z=360,-Z 
IF(Z.LE.-270,) Z=360.+Z 

NONFILTERED GROUND SPEED CALCULATION 

DRANGE=RANGE ( J )-RAN6E ( J- 1 ) 
DBEAR=(BEAR(J)-BEAR(J-l))»p|/180. 

I F (DBEAR.6E.4 .46804 ) DSEAR=2 . »P I -DBEAR 
IF(D0EAR.LE.-4.468O4) DBEAR=2 . «P i -H)BEAR 
GS0=SQRT (DR AN6E*»2+ (RANGE ( J ) *0BEAR ) *»2 )/T I ME 
IF(J.NE,2) 60 TO 199 
IF(J.NE.2) GO TO 199 
GSP=GS0 
ACP=0,0 
GO TO 9 

FILTERED GROUND SPEED CALCULATION, INTERVAL=1 CYCLE 

199 GSS=GSP+ALP»(GSO-GSP) 

ACS=ACP+BET»(GSO-GSP )/TI ME 
GSF=GSS+TIME«ACS 
GSP=GSF 
ACP-ACS 
GSF=ABS(GSF) 

IF(J.LE.4) GO TO 9 

FILTERED GROUND SPEED CALCULATION, INTERVAL=4 CYCLES 

DP.ANGE=RAN6E( J )-R ANGE ( J-4 ) 

DBEAR= (BEAR ( J )-BEAR ( J-4 ) ) *P I / 1 80. 

I F(DBEAR.GE. 4.46804) 0BEAR=2 I -DBEAR 
IF(DBEAR.LE.-4.46804) DBEAR=2.*tpi+DBEAR 
GS40=SQRT ( ORANGE »»2+ (RANGE ( J ) »0BEAR ) »*2 ) / (T 1 ME «4 . ) 
IF(GS40.LE.20.0) GS40=0.0 
IF(J.£Q.5) GS4P=GS40 
IF(J.EQ.5) AC4K0.0 
GS4S=GS4P+ALP»(GS40-GS4P ) 
AC4S=AC4P+BET*(GS40-GS4P)/TIME 
GS4=GS4S+AC4S»TIME 
GS4P=GS4 

!F(GS4.LE.30.0) GS4=0.0 
IF(GS4.EQ.0.) GO TO 444 

ESTIMATED TIME OF ARRIVAL CALCULATION 

ETA=RANGE(J)/GS4 
IETA=IFIX(ETA)»10000 
TMP2= ( ETA- I F I X (ETA ) ) *60 . 

I ETA= I ETA+( I F I X (TMP2 ) *1 00 ) 

TNP2=(TMP2-IFIX(TMP2) )*60. 

IETA=IETA+IFIX(TMP2) 

CTE/CTEB CALCULATION 

444 CrEB=BEAR(J)-ANGLE 

IF(CTEB.LT.O.) GO TO 111 
C 

SIDE=1 

IF(CTEB.GE.270.) CTEB=380.-CTEB 
IF(CTEB.GT.180.) SIDE=0 
GO TO 222 
C 

111 SI0E=1 

IF(CTEB.GE.-180.) SlDE=0 
IF(CTEB.LE.-270.) CTEB=€TEB+360. 
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CTEB«ABS(CTE8) 

CC-ftANGE(J)/R 
BB^iTEB»P 1/180. 

AA«SIN(BB)»SIN<CC) 

CTE-ARSIN(AA)^^ 

CTE-ABS(CTE) 

CTE-RIGHT, -CTE»LEFT 
IF(SIDE.EQ.O) CTE«-CTE 
IF(Z.GE.-90..AND.2.LT.90.) GO TO 333 
CTE—CTE 
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1«ITE(2,200) TH^EVENT, I POS, I ETA,RANGE< J ) ,BEAR ( J ) .GSO.CTEB.OTE.GSO 
1 GSF,G34 

FORMAT(2(F9.2,3X),12,3(IX,l6),8(F6.r)) 

J-J+1 


PPOS(1)»POS(I) 
PPOS(2)»POS(2) 
I ETA-999999 
GO TO 10 
300 STOP 
END 


THIS SUBROUTINE CONVERTS TIME DIFFERENCES TO COORDINATES OF 
POSITION. 

SUBROUTINE DEXLRN(TH,POS) 

C 

OIMENSlOH TH(2),P0S(2) 

DATA TCY,TCZ/7..9E-2,5.4E-2/ 

DATA ThMY/0. 151292 58/ ,T WZ/0 . 1 4849557/, XNR/46 , 986746/ 

DATA CTMY/0.98857709/,STMY/0. 15071607/,CTMZ/0. 98899478/ 
DATA STMZ/0.14795043/,CXK/0.37466368/,SXK/0.92716079/ 

DATA Cl/2,983207l/,C2/4.3lll683/,C3/-7. 17171 16/ 

DATA C4/4.0896360/.C5/-4, 4643647/ ,C6/1 .1496479/ 

DATA e7/~5,0510869/,C8/5.1 185063/ ,09/0.5592 1480/ 

DATA C10/1.5850077E-3/,Cl l/2.5836473£-4/,C12/-2.9620318E-3/ 
DATA C13/1 .5850077E-3/,C14/l .0034014/ 

DATA PI/3.141592/ 

C 

TY-TH(l)»l.E-6 

TZ»TH(2)*l.E-6 

C 

PY-XNR»(TY-TCY)-THMY 
PZ»XNR»(IZ-TCZ )-THMZ 
GPY=»COS(PY) 

SPY-SI N(PY) 

CPZ-OOS(PZ) 

SPZ«SIN(PZ) 

AY»(CPY-CTMY)/STMY 

AZ»(CPZ-CrMZ)/STMZ 

BY-SPY/STMY 

BZ-SPZ/STMZ 

U1»AY*CXK-AZ 

U2-AY»SXK 

U3-AZ*8Y-AY<f8Z . 

UU-U1»U1+U2»U2 

COBY»< U3*U t -HJ2»S0RT {UU-U3»U3 ) )/UU 
THMS-ATAN(AY/<BY+CD8Y) ) 

CB-COS(THMS) 

CA-COS (THMS+PY) 

CC-COS(THMS-tPZ) 

C 

F=C1 »CA+C2*CB+C3*CC 
G=C4*CA-K;5*CB+C6*CC 
H=C7«CA+C8«C8+C9»CC 
C 

THGS-ATAN ( (G4C1 0) /(F+Cl 1 ) ) 

PHGS=ATAN(G14*C14«SIN(THGS)»(H+C125/(G+C13)) 

POS<2)=THGS»180./PI 

POS(1)=PHGS»I80./PI 

RETURN 

END 


oo oo 


f 


ORIGINAL PAGE IS 
OF POOR QUALITY 

THIS SUBROUTINE CALCULATES RANGE TO THE WAYPOINT AND BEARING 
TO TRUE NOfTTH. 

SUBROUTINE RABE(POS, RANGE, BEAR,J) 

DIMENSION POS (2 ) ,RAN6E { 1 000 ) , BEAR ( 1 000 ) 

REAL LA1,L01,LA2,L02,M,N 
DATA PI/3. 1415926535898/,A/3443.9174/ 

C COORDINATES OF THE TO WAYPOINT 
LA2=>0. 68467327 
L02=1. 4352181 8 

C COORDINATES OF THE RECEIVER POINT 
LA1=POS(1)*PI/180. 

LOI=POS(2)*PI/180. 

FF=1. - 1./298.2 
F=l./298.2 
0LO=L01-LO2 
TB=FF»TAN(LA1) 

TBI»FF«TAN(LA2) 

a=ATAN(TB) 

BI~ATAN(TBI ) 

C1=COS(BI )»SIN(DL0) 

C2=COS(B)^‘SIN(BI )-SIN(B)«COS(Bl )<^OS(DLO) 

C3=SIN(B)i‘SIN(BI )+COS(B)»COS(B( )*COS(DLO) 

8A=ATAN(C1/C2) 

TH=ATAN((C2«C0S(BA)+C1»SIN(BA))/C3) 

M=(SIN(B)+SIN<BI ))*»2 
N=((SIN(B)-S1N(BI ))/SlN(TH))*»2 
U=((1.-00S(TH))/SIN(TH))'‘»2 
V=(l.+COS(TH)}»(TH+SIN(TH)) 

RANGE ( J ) =ABS (A» (TH-F * (M*U+N <*V )/4 . ) ) 

BEAR(J)=BA»180./PI 
IF(C2.LE.O.) BEAR (J)=BEAR(J 5+180. 

IF(C1.LE.O..AND.C2.GE.O.) BEAR(J)-360.+BEAR( J) 

RETURN 

END 
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